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Abstract 

The  Turkish  Air  Eorce  (TuAE)  has  started  a  project  to  launch  a  satellite  using  only 
Turkish  resources.  Primary  motivation  behind  this  research  is  to  assist  TuAE’s  project  by 
keeping  up  with  these  innovations  in  the  navigational  arena.  The  basic  challenge  in 
navigation  system  design  is  to  decide  which  navigation  system  (or  systems)  and 
implementation  techniques  will  be  used,  depending  on  accuracy  requirements.  The  two 
primary  navigation  systems  that  will  be  integrated  in  this  research  are  the  Inertial 
Navigation  System  (INS),  and  the  Global  Positioning  System  (GPS).  The  Kalman  filter 
algorithm  is  used  to  integrate  INS  and  GPS.  The  rocket  (Atlas  HAS  launch  vehicle)  flight 
profile  is  generated  by  using  PROEGEN  and  simulated  "true"  GPS  ephemeris  data  is 
incorporated  into  system  as  GPS  measurements.  The  "modified"  alternative  system 
performance  analysis  tool,  MatSOEE,  is  utilized  in  this  research  study.  Standard  and 
differential  GPS  are  compared,  as  are  three  different  grades  of  INS,  in  a  tradeoff 
performance  analysis. 


XVI 


Performance  Tradeoff  Study  of  a  GPS-Aided  INS  for  a  Rocket 

Trajectory 

/.  Introduction 

The  Turkish  Air  Force  (TuAF)  has  started  a  project  to  launch  a  satellite  using  only 
Turkish  resources.  In  any  space  program,  navigation  systems  have  substantial 
importance.  According  to  open  literature,  there  are  more  than  10,000  satellites  orbiting 
around  the  Earth.  Space  navigation  systems  have  widely  been  used  in  applications  for 
more  than  thirty  years,  but  the  innovations  in  navigation  sensors  technology  and  the 
implementation  techniques  of  these  sensors  have  been  rapidly  developing.  The  primary 
motivation  behind  this  research  is  to  assist  TuAF’s  project  by  keeping  up  with  these 
innovations  in  the  navigational  arena. 

The  basic  challenge  in  navigation  system  design  is  to  decide  which  navigation 
system  (or  systems)  and  implementation  techniques  will  be  used,  depending  on  accuracy 
requirements.  The  two  primary  navigation  systems  that  will  be  integrated  in  this  research 
are  the  Inertial  Navigation  System  (INS),  and  the  Global  Positioning  System  (GPS).  An 
integrated  GPS-aided  INS  system  will  be  investigated  in  this  study  because  the  strengths 
and  shortcomings  of  these  individual  navigation  systems  are  complementary,  and 
therefore  a  considerable  performance  gain  will  be  achieved  by  integrating  them  together. 
The  Kalman  filter  algorithm  is  used  to  integrate  INS  and  GPS.  The  integration  technique 
used  in  an  INS/GPS  system  is  named  depending  on  the  type  of  measurements  used  in  the 
integration  Kalman  filter:  for  instance,  loosely  coupled,  tightly  coupled  or  ultra-tightly 
coupled.  The  detailed  insights  related  to  these  systems  will  be  given  in  the  next  section. 


I-l 


but  these  terms  will  be  briefly  deseribed  here.  Loosely  coupled  systems  are  integrated  at 
the  navigation  solution  level.  Both  INS  position  data  and  GPS  position  data  are  taken  into 
the  Navigation  Kalman  filter.  Tightly  coupled  systems  are  integrated  at  the  pseudorange 
level,  and  ultra-tightly  coupled  systems  at  the  in-phase  and  quadrature  (I  and  Q)  signal 
level.  In  this  study  the  tightly  coupled  integration  technique  will  be  used  to  integrate  INS 
and  GPS.  The  justifications  for  this  choice  will  be  presented  in  the  background  section. 

It  is  believed  that  an  integrated  INS/GPS  system  can  meet  and  exceed  both  the 
navigation  accuracy  and  integrity  requirements  for  a  satellite  to  launch.  In  this  study,  the 
author  will  investigate  the  performance  of  different  types  and  navigation  accuracies  of 
GPS-aided  INS  systems,  and  make  a  tradeoff  analysis  between  their  cost,  applicability, 
accuracy,  implementation  ease,  etc.  To  achieve  this  goal,  6  different  cases,  each  case 
involving  a  separate  GPS-aided  INS  system  with  different  navigation  accuracies,  were 
constructed. 

This  research  investigates  only  the  navigation  aspect  of  space  navigation  systems. 
The  study  of  designing  a  control  algorithm  for  a  space  vehicle  could  also  be  studied,  but 
it  is  considered  as  the  follow-on  step,  and  will  not  be  discussed  in  this  thesis. 

1.1  Background 

The  inertial  sensors,  like  accelerometers  and  gyros,  used  in  an  INS  have  some 
errors  with  stochastic  properties.  These  errors  tend  to  increase  over  time  (long-term 
instability)  with  unbounded  position  error  growth  and  require  occasional  or  continual 
compensation  [17:  526].  Its  autonomous  navigation  capability  makes  INS  the  primary 
navigation  system  in  most  applications.  It  does  not  need  any  external  aid  to  navigate,  but 
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its  accuracy  can  be  improved  by  using  navigational  aids  (GPS,  TACAN,  RADAR,  ete.)- 
On  the  eontrary,  GPS  alone  does  not  provide  an  adequate  solution  either,  “due  to  low 
output  rate  of  GPS  reeeivers  and  the  need  for  redundant  information  during  GPS  system 
failures  or  simple  loss  of  GPS  measurements  [44:  2932]  GPS  has  long-term  aceuraey, 
but  is  sensitive  under  highly  dynamie  conditions,  such  that  the  number  of  traeked 
satellites  may  fall  below  four,  whieh  means  the  GPS  reeeiver  can  no  longer  generate  a 
navigation  solution  on  its  own.  The  integrated  INS/GPS  system  not  only  provides  a  very 
efficient  means  of  navigation  due  to  the  short-term  aeeuraey  of  INS  eombined  with  the 
long-term  aeeuraey  of  GPS,  but  also  produees  a  system  with  performanee  that  exeeeds 
that  of  the  individual  sensors. 

There  are  several  options  to  integrate  the  GPS  and  INS  sensors.  Among  these 
options,  two  traditional  integration  teehniques  are  widely  used  in  applieations:  loosely 
eoupled  (Figure  I-l)  and  tightly  eoupled  (Figure  1-2).  In  the  open  literature,  there  are 
numerous  navigation  system  designs  using  these  teehniques.  Both  have  advantages  and 
disadvantages. 

In  a  loosely  eoupled  system,  the  INS  integration  Kalman  filter  uses  GPS-derived 
position  and  veloeity  (the  output  of  a  GPS  Kalman  filter)  as  a  measurement.  Loosely 
eoupled  integration  treats  GPS  and  INS  as  individual  navigation  systems,  eombining  the 
two  at  the  navigation  solution  level.  Raw  GPS  data  is  proeessed  first  by  a  Kalman  filter, 
and  the  integration  Kalman  filter  is  then  applied  to  eombine  INS  and  GPS  navigation 
solutions.  Often  only  the  INS  error  states  are  modeled  explieitly  in  the  integration 
Kalman  filter.  That  does  not  mean  that  GPS  is  assumed  error-free,  only  that  the  dynamie 
eharacteristics  of  the  GPS  errors  are  not  eompensated  by  the  integration  filter.  The  GPS 
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Figure  1-1.  Loosely  coupled  INS/GPS  integration 


Uncorrected  Corrected 

Position  Position 


Figure  I-2.  Tightly  coupled  INS/GPS  integration 


has  its  own  Kalman  filter  inside  the  receiver,  which  at  least  models  four  outputs  of  the 
GPS-alone  solution,  namely  three  positions  and  a  clock  time  offset.  It  is  a  well-known 
fact  that  you  need  at  least  four  equations  to  solve  four  unknowns.  Similarly,  the  GPS 
receiver  provides  a  three-dimensional  position  (x,  y,  z)  and  time  estimate  provided  that  a 
minimum  of  four  satellites  is  being  tracked.  See  Figure  1-3. 

Tightly  coupled  INS/GPS  integration  combines  both  INS  and  GPS  measurements 
in  an  integrated  Kalman  filter.  The  INS/GPS  Kalman  filter  estimates  the  errors  in  vehicle 
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If  N  >4,  solve  for  user  position(x,y,z) 
and  receiver  clock  bias  b 


Figure  1-3.  The  Principle  of  Satellite  Navigation  [25] 

position,  velocity  and  attitude  along  with  Inertial  Measurement  Unit  (IMU)  errors,  such 
as  gyro  drift,  and  accelerometer  bias,  and  GPS  errors,  such  as  clock  bias  and  drift  rate,  by 
using  both  INS  position  solution  and  GPS  pseudorange  measurements  [41:  773].  Thus, 
the  integration  is  performed  at  the  pseudorange  measurement  level  rather  than  at  the  GPS 
navigation  solution  level.  Only  one  Kalman  filter  is  applied  in  this  integration  technique. 
Positioning  is  performed  on  the  basis  of  both  INS  and  GPS  measurements,  even  if  the 
number  of  tracked  satellites  falls  below  four.  Since  they  are  integrated  at  the  raw  in-phase 
and  quadrature  phase  (I  &  Q)  signal  level  and  provide  a  position  estimate  with  an 
accuracy  of  cm  level,  and  are  still  under  development,  ultra-tightly  coupled  systems  are 
not  considered  as  a  concern  of  this  study.  Additionally,  since  the  desired  position 
accuracy  of  a  launch  vehicle  is  about  50-80  meters,  the  author  decided  not  to  consider 
ultra-tightly  coupled  systems  in  this  study. 
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There  are  three  main  GPS  types,  depending  on  GPS  receiver  range  solution 
technique:  (1)  Standard  GPS,  (2)  Code  Range  Differential  (DGPS),  and  (3)  Carrier  Phase 
DGPS.  For  the  military  applications  their  Two-Dimensional  Distance  Root  Mean  Square 
(2  DRMS)  horizontal  position  accuracies  are  approximately  6  m.,  1-3  m.,  and  1-2  cm., 
respectively  [34],  2  DRMS  is  the  root  mean  square  (RMS)  of  the  two-dimensional 


distance  error 


(drms 


n  ).  The  probability  of  being  inside 


2xDRMS  circle  varies  between  95%  and  98%  (depending  upon  ratio  of  <7^  and  <7^  ). 

The  basic  difference  between  them  is  the  type  of  information  which  the  GPS  receiver 
uses  to  generate  a  navigation  solution.  The  incoming  GPS  signal  consists  of  three 
components:  carrier  (RF  sinusoidal  signal,  which  is  usually  called  phase,  or  carrier 
phase),  ranging  code  (basically  zeros  and  ones,  and  briefly  called  code  or  PRN  code), 
and  navigation  data  (a  binary  coded  message)  [25].  The  differential  GPS  technique  takes 
advantage  of  the  error  correlations  between  multiple  receivers.  Its  accuracy  is  anywhere 
between  5  m.  and  1  cm.,  depending  upon  the  method  used.  Obviously,  carrier  phase 
DGPS  provides  the  highest  precision  when  compared  to  the  others  [34].  Taking  the 
accuracy  requirements  of  a  launch  vehicle  into  account,  the  research  cases  related  to 
carrier-phase  DGPS-aided  INS  systems  are  removed  from  the  research  scope.  It  was 
obvious  that  carrier-phase  DGPS  would  provide  much  more  accuracy  than  what  is 
needed.  Detailed  information  related  to  GPS,  DGPS,  and  Carrier-Phase  GPS  can  be 
found  in  Key  Terms  (next  page)  and  Chapter  2.4  of  this  study. 
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1.2  Key  Terms 

Inertial  Navigation  System  (INS):  A  self-contained,  dead  reckoning  precision 
navigation  system,  which  uses  inertial  sensors,  such  as  gyroscopes  and  accelerometers,  to 
provide  navigation  information.  Typical  accuracy:  0.4-4. 0  nautical  miles/hour  circular 
error  probable  (CEP).  CEP  defined  as  radius  of  a  circle  inside  which  half  of  the  points 
(errors)  fall (  CEP  =  0.59 (  a^+CTy  )  + 3%)  . 

Global  Positioning  System  (GPS):  A  passive,  space-based,  universal  and  accurate 
source  of  navigation  information  (three-dimensional  position  and  velocity)  and  time.  The 
system  has  been  designed,  developed,  and  maintained  by  the  U.S.  Department  of 
Defense  (DoD)  [6,9,10,44].  Accuracy:  Stand-Alone  GPS  is  typically  6  meters  (military, 
dual  frequency)  and  10  meters  (civilian)  approximate  horizontal  accuracy  (2DRMS)  [34]. 

Differential  GPS  (DGPS):  A  ground-based  GPS  receiver  (accurately  surveyed) 
uplinks  error  corrections  to  nearby  vehicles  to  be  positioned.  DGPS  takes  advantage  of 
the  correlation  of  errors  between  receivers.  The  errors  associated  with  the  worst  error 
sources  are  similar  for  users  located  “not  far”  from  each  other,  and  they  change  slowly  in 
time.  In  other  words,  errors  are  correlated  both  spatially  and  temporally.  Clearly,  an  error 
in  a  measurement  can  be  estimated  and  removed  up  to  a  certain  level  by  using  proper 
DGPS  techniques,  if  the  location  is  known  [25].  Accuracy:  1-5  meters,  depending  upon 
method  used  [34]. 

Carrier-Phase  DGPS:  A  very  popular  and  accurate  receiver  technique,  which  is 
able  to  measure  the  incoming  satellite-transmitted  GPS  signal  to  a  fraction  of  a 
wavelength.  Accuracy:  1-2  centimeter  [10,  34]. 
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Kalman  Filter:  A  recursive  computer  algorithm  that  uses  sampled-data 
measurements  to  produce  optimal  state  estimates  of  a  dynamical  system,  under  the 
assumptions  of  linear  system  models  and  white  Gaussian  noise  models.  Developed  by 
R.E.  Kalman  in  the  early  1960s,  A  New  Approach  to  Linear  Filtering  and  Prediction 
Problems  [16]. 

Barometric  Altimeter:  An  altimeter  designed  to  output  altitude  relative  to  the 
pressure  difference.  They  are  cheap  and  widely  used  as  vertical  channel  aid  to  INS 
because  of  the  inherent  instability  of  the  vertical  channel  in  an  unaided  INS  [10]. 

1.3  Literature  Review 

The  following  is  a  brief  discussion  of  the  literature  reviewed  for  this  research, 
process,  which  covers  NASA  technical  reports,  previous  Air  Force  Institute  of 
Technology  (AFIT)  theses,  text  books,  course  handouts,  and  IFFF  transactions  and 
conferences  related  to  the  INS/GPS  integrated  navigation  system  and  its  space 
applications.  The  reviewed  sources  will  be  presented  in  following  categories 

1.3.1  Benefits  of  Integrated  Systems 

The  inertial  sensors  used  in  an  INS  have  some  errors  and  these  errors  tend  to 
increase  by  time.  They  have  to  be  compensated  occasionally  or  frequently.  Although  an 
INS  provides  good  high-frequency  navigation  information,  it  has  considerable  long-term, 
low  frequency  errors  due  to  the  physical  gyro  drift  rate  problem.  The  use  of  navigational 
aids,  like  GPS  and  a  barometric  altimeter,  can  significantly  enhance  the  navigation 
accuracy  of  an  INS. 
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All  of  the  GPS  range  solution  teehniques  (either  stand-alone  or  differential)  suffer 
from  some  inadequacy.  The  most  significant  are: 

•  The  data  rate  of  GPS  receiver  is  too  low  for  many  applications; 

•  High  DGPS  accuracy  is  limited  by  the  distance  between  the  reference 
station  and  the  user  because  of  the  errors  associated  with  the  ionosphere, 
which  make  it  difficult  to  determine  the  integer  ambiguity  resolution  on- 
the-fiy  [13]; 

•  Influences  of  high  acceleration  on  the  receiver  clock,  code  tracking  loop 
(delay  lock  loop)  and  carrier  phase  loop  may  become  considerable;  these 
tracking  loops  are  used  to  provide  estimates  of  tracking  errors  for  signal 
processing  purposes  in  a  GPS  receiver; 

•  Signal  loss-of-lock  and  cycle  slips  may  occur  very  frequently  due  to 
aircraft  high  dynamics  and  other  causes  [35:  18-12], 

INS/GPS  integration  has  proven  to  be  a  very  efficient  means  of  navigation  due  to 
the  short  term  accuracy  of  INS  combined  with  the  long  term  accuracy  of  GPS  fixes 
[4,7,8,17,35,41],  INS/GPS  integration  is  the  optimal  solution  to  the  navigation  problem 
rather  than  using  either  system  alone,  since  the  Kalman  filter  includes  effects  of  both 
GPS  and  INS  errors.  “Many  researchers  have  studied  the  methodology  of  combining 
these  two  navigation  sensors.  Navigation  employing  GPS  and  INS  is  a  synergistic 
relationship.  The  integration  of  these  two  types  of  sensors  not  only  overcomes 
performance  issues  found  in  each  individual  sensor,  but  also  produces  a  system  whose 
performance  exceeds  that  of  the  individual  sensors.”  [17:  526], 
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INS  and  GPS  are  complementary  technologies  in  the  sense  that  the  weakness  of 
one  is  the  strength  of  another.  Integration  of  INS  and  GPS  leads  to  a  particularly 
attractive  and  robust  system  that  can  produce  better  navigation  information  compared  to 
either  one. 

1.3.2  INS/GPS  Integration  Techniques 

“There  are  many  options  to  integrate  the  INS  and  GPS  onboard  the  spacecraft. 
The  first  integration  option,  also  the  simplest  implementation  technique,  is  resetting  the 
position  and  velocity  output  of  INS  with  that  of  GPS.  This  option  was  selected  as  the 
baseline  INS/GPS  integration  approach  on  the  NASA/TRW  orbit  maneuvering  vehicle 
(OMV)  [41].” 

The  second  option,  called  loosely  coupled  or  cascaded  integration,  basically  takes 
the  output  of  a  GPS  Kalman  filter  (position  and  velocity  solution)  as  measurements  into 
integration  Kalman  filter.  This  integration  behaves  like  an  INS  alone  system  in  case  of 
GPS  outages. 

The  third  integration  option,  called  tightly  coupled  INS/GPS  integration, 
combines  the  GPS  pseudorange  and/or  range  rate  measurement  and  INS  raw 
measurements  in  an  integration  Kalman  filter.  Having  only  one  Kalman  filter  is  not  the 
only  difference  between  loosely  and  tightly  coupled  systems.  The  fundamental  difference 
is  using  raw  measurements  instead  of  the  navigation  solution  for  GPS.  The  INS/GPS 
integration  Kalman  filter  estimates  the  errors  in  spacecraft  position,  velocity  and  attitude 
along  with  the  inertial  measurement  unit  (IMU)  instrument  errors,  such  as  gyro  drift  and 
accelerometer  bias  and  scale  factor.  This  tightly  coupled  integration  option  gives  the  best 
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navigation  accuracy  of  the  three  teehniques  just  diseussed,  and  it  does  not  suffer  from  the 
filter-driving-filter  (the  GPS  reeeiver  Kalman  filter-driving-integration  Kalman  filter) 
stability  eoneem  of  the  loosely  eoupled  approaeh  [41,  23]. 

An  additional  literature  review  was  also  eondueted  to  find  out  whether  anything 
new,  espeeially  in  the  GPS  portion  of  the  navigation  system  and  its  applieation  in  spaee 
navigation  area,  had  been  aeeomplished  that  would  provide  different,  or  additional, 
models  to  be  ineorporated  into  this  researeh.  In  NASA’s  teehnieal  reports  and  eontraetor 
reports,  it  is  seen  that  the  aecuraey  expeeted  from  a  space  navigation  system  (GPS-aided 
INS  and  some  navigational  aids,  sueh  as  barometrie  altimeter,  star  traeker,  ete.)  is  in  the 
level  of  50  meters  per  channel  CEP  [26,40]. 

1.3.3  Integration  Kalman  Filter  Error  and  Measurement  Models 

Onee  the  error  models  for  the  navigational  systems  are  determined,  the  rest  of  the 
Kalman  filter  design  is  relatively  straightforward.  Navigational  systems  (GPS,  INS, 
barometric  altimeter,  ete.)  error  models  are  named  depending  on  their  state  number,  for 
instance,  an  1 1-state  INS  error  model  or  a  30-state  GPS  error  model.  Each  state  within 
that  speeified  number  of  states  represents  a  speeifie  sensor  error,  whieh  we  want  the 
Kalman  filter  to  estimate  and  eompensate.  The  previous  AEIT  theses  aeeomplished  by 
Gray  [10],  Britton  [6],  and  White  [44],  guided  this  part  of  literature  review.  Aetually, 
Gray’s  thesis  was  the  basis  for  the  other  two.  The  error  models  and  measurement  models 
they  used  have  been  analyzed  and  validated  for  almost  ten  years  in  AEIT  theses.  These 
models  have  proven  their  aeeuraey  in  many  applieations.  However,  to  be  100%  eonfident 
about  the  truthfulness  of  these  models,  they  are  ehecked  onee  again  and  matehed  with  the 
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information  available  in  Performance  Accuracy  (Truth  Model/Error  Budget)  Analysis  for 
the  LN-93  Inertial  Navigation  Unit  documentation  [18].  The  detailed  INS,  GPS, 
barometric  altimeter  error  and  measurement  models  will  be  delineated  in  Chapter  3  of 
this  study. 

1.3.4  The  Chosen  Launch  Vehicle  (Atlas  HAS)  for  Simulations 

To  accomplish  this  study,  both  the  GPS  and  the  INS  data  have  to  be  generated  and 
inserted  into  the  simulation  environment.  A  Fortran-based  Flight  Profile  Generator 
(PROFGEN)  generates  the  INS  data  for  the  rocket  flight  trajectory  [29].  PROFGEN  is 
capable  of  providing  53  different  output  variables  to  the  user,  and  the  user  can  choose  the 
preferred  number  of  output  variables.  To  run  this  Profile  Generator,  one  has  to  have  the 
vehicle  flight  characteristics  (take-off  coordinates,  vehicle  initial  heading,  checkpoints, 
flight  lengths,  etc.)  in  hand  and  has  to  put  those  data  into  profile  input  (PROF_IN)  file. 
Detailed  information  concerning  PROFGEN  and  rocket  flight  profile  generation 
procedures  will  be  presented  in  Section  3.3  and  4.2  of  this  study.  As  a  result  of  personal 
interview  with  Dr.  Tregesser  [39]  from  the  aerospace  department  and  the  reviewed 
literature  [15,19],  the  Atlas  HAS  launch  vehicle  (Figure  1-5)  was  chosen  as  the 
“optimum”  in  terms  of  applicability,  cost,  orbit  specifications,  flight  statistics  and  thrust 
[15].  The  operational  Atlas  II  family  is  one  of  the  largest  commercial  launch  vehicles  in 
the  United  States  and  is  currently  operating  with  a  100%  mission  success  rate.  As  of 
June  19,  2001,  Atlas  HAS  has  achieved  22  for  22  successful  missions,  for  a  total  of  55 
consecutive  successful  Atlas  flights  [15].  “Based  on  open-source  information,  the  Federal 
Aviation  Administration  (FAA)  estimates  $  90-105  million  price  range  for  commercial 
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Atlas  HAS  [15]”.  Atlas  HAS  is  not  only  the  optimum  choice  for  simulation,  but  also  it  is 
the  most  realistic  Low  Earth  Orbits  (LEO)  launch  vehicle  (see  Eigure  1-4  for  Earth  orbits 
diagram).  Eurthermore,  GPS  data  is  extensively  being  used  for  space  vehicles  in  LEO’s 
(below  3000  km)  [26].  Detailed  information  concerning  Atlas  launch  vehicles,  as 
depicted  in  Eigure  1-5,  can  be  found  on  the  Lockheed  Martin  Corporation’s  web  site  [19] 
and  International  Reference  to  Space  Launch  Systems  (third  edition),  AIAA  technical 
publications,  1999  [15]. 


Figure  1-5.  Atlas  HAS 
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1.4  Problem  Statement 


As  mentioned  previously,  this  study  has  started  with  examining  the  theses 
aeeomplished  by  former  AFIT  students  Robert  A.  Gray  [10],  Capt.  Ryan  Britton  [6],  and 
2nd  Lt  Nathan  White  [44],  These  theses  are  eoneerned  with  aecurate  GPS/INS 
integrations  for  a  preeision  landing  or  airborne  navigation  applieation,  rather  than  for  a 
satellite  launeh.  It  has  seen  that  the  truth  models  and  filter  design  error  models  they  used 
for  INS  and  GPS  have  been  utilized  in  AFIT  for  more  than  8  years  as  validated  models, 
and  eonsequently  the  author  deeided  to  use  these  models  in  this  researeh. 

This  researeh  will  eoncentrate  on  performances  of  different  types  and  accuracies 
of  GPS-aided  INS  systems  and  will  make  a  tradeoff  analysis  between  their  cost, 
applicability,  accuracy,  implementation  ease,  etc.  to  assist  TuAF’s  space  project.  The 
tradeoff  study  will  be  accomplished  based  on  the  performance  analysis  between  6 
differently  constructed  cases.  Each  case  represents  a  tightly  coupled  integration  of  these 
two  types  of  GPS  (standard  single-receiver  GPS,  dual  frequency  P-code  DGPS)  with 
three  grades  of  INS  (0.4,  2.0,  and  4.0  nm/hr  CEP  INS).  These  three  grades  of  INS’s 
represent  military  grade,  commercial  grade,  and  less  expensive  (possible  MEMS  in  a  few 
years)  Inertial  Navigation  Systems.  The  constructed  cases  are  shown  in  Table  I-l. 

In  Cases  I  and  II,  the  0.4  nm/hr  CEP  INS  will  be  integrated  with  two  different 
accuracies  of  GPS  data,  namely  standard  single-frequency  stand-alone  GPS,  and  P-code 
DGPS.  Cases  III  through  IV  and  Cases  V  through  VI  achieve  the  same  integrations  for 
2.0nm/hr  CEP,  and  4.0  nm/hr  CEP  INS’s,  respectively. 


1-14 


Table  1-1.  Case  l-VI  integration  comparison 


Case  1 

Case  II 

Case  III 

Case  IV 

Case  V 

Case  VI 

0.4  nm/hr 
CEP  INS 

0.4  nm/hr 
CEP  INS 

2.0  nm/hr 
CEP  INS 

2.0  nm/hr 
CEP  INS 

4.0  nm/hr 
CEP  INS 

4.0  nm/hr 
CEP  INS 

Single-Freq 

Standard 

GPS 

Dual-Freq 

P-code 

DGPS 

Single-Freq 

Standard 

GPS 

Dual-Freq 

P-code 

DGPS 

Single-Freq 

Standard 

GPS 

Dual-Freq 

P-code 

DGPS 

Barometric 

Altimeter 

Barometric 

Altimeter 

Barometric 

Altimeter 

Barometric 

Altimeter 

Barometric 

Altimeter 

Barometric 

Altimeter 

Note:  Baro-Altimeter  is  used  up  to  80.000  feet.  The  Atlas  launeh  vehiele  reaches  that  altitude  at  53 
seconds  into  the  simulation.  When  the  total  flight  time  of  1450  seconds  is  compared  to  that,  it  can  be  said 
that  the  baro-altimeter  has  no  appreciable  contribution  to  the  overall  performance. 


The  biggest  ehallenge  for  this  thesis  was  to  establish  a  “tool”,  a  simulation 
program,  to  generate  eaeh  of  these  6  different  eases  in  a  eomputer  environment.  The 
Matlab-based  [37]  “MatSOFE”  (quoted  beeause  the  author  refers  to  the  version  first 
ereated  by  former  AFIT  student  William  B.  Mosle  [27]  ini 993  and  modified  by  Pamela 
L.  Harms  [12]  in  1995  for  Sverdrup  Teehnology,  Ine.,  TEAS  Group)  Monte  Carlo 
performanee  analysis  tool  provided  by  AFIT/ENG  was  ereated  for  a  speeial  ease.  In  this 
form,  it  was  not  comprehensive,  designed  for  a  simple  specific  problem  with  short  flight 
hours,  and  especially  was  not  convenient  for  the  cases  mentioned  above  in  terms  of  truth 
and  filter  model  state  dimensions,  “Pinson  error  model”  definition,  and  the  GPS  data 
used.  The  author  also  received  the  original  version  MatSOFE  in  March  2001.  Although  it 
has  some  written  codes  for  the  purpose  of  GPS-aided  INS  applications,  it  was  not  taking 
any  GPS  measurement  to  update  the  integrated  system.  Because  of  that,  most  of  the  effort 
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was  spent  to  modifying  the  simulation  eode  and  writing  new  eode,  depending  on  needs 
for  eaeh  integration  ease.  By  January  2002,  the  MatSOFE  has  reached  its  present,  revised 
form.  The  current  version  of  MatSOFE  is  capable  of  taking  real  GPS  satellite  vehicle 
ephemeris  data  by  using  the  System  Effectiveness  Model  for  Windows  Version  3.6.4. 
(WSEM  3.6)  software  [2]  for  measurement  updates.  Also,  the  EID  covariance 
factorization  filter  principles,  developed  by  Bierman  and  Thorton  [20;  392],  were 
incorporated  for  propagation  and  measurement  update  cycles.  El-D  factorization 
algorithm  increases  the  numerical  stability  in  the  Kalman  filter.  The  39-state  reduced 
truth  model  of  Eitton  93-state  (EN-93)  INS  [18],  which  is  the  most  common  INS  in  the 
market  and  being  used  by  the  F-I6  Fighting  Falcon  aircraft,  is  also  integrated  into  current 
version.  Detailed  information  about  MatSOFE,  error  states,  Pinson  error  model,  real  GPS 
satellite  vehicle  ephemeris  data,  WSEM  software  program  and  EN-93  INS  definitions 
will  be  presented  in  next  chapter. 

Even  though  most  of  the  reviewed  subjects  were  familiar  and  studied  during  my 
AFIT  academic  education,  many  additional  insights  related  to  INS,  GPS,  and  their 
integration  techniques  were  gained  in  the  literature  review  phase.  Those  insights  will  be 
used  during  both  the  simulation  and  tradeoff  analysis  phase. 
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7.5  Assumptions 

All  theses  are  limited  by  the  assumptions  made,  and  no  researeh  ean  be 
adequately  evaluated  unless  these  assumptions  are  elearly  defined  [27].  This  seetion 
outlines  the  assumptions  that  have  been  made  in  this  thesis  [10]. 

i.  All  work  is  to  be  eondueted  through  eomputer  simulation.  “Real 
world”  data  is  neither  eolleeted  nor  used  in  the  simulations.  Instead,  all  “real 
world”  measurements  are  aceurately  simulated.  There  is  true  satellite  vehiele 
ephemeris  data  within  the  WSEM  3.6  software,  but  the  aetual  GPS 
measurements  themselves  are  simulated  in  the  eomputer  environment.  The 
emphasis  here  is  on  the  model  representing  the  real  world  eonditions  in  the 
filter  design.  The  real  world  data  used  in  the  simulation  is  modeled  with  a  full- 
order  truth  error  state  model.  MatSOFE  provides  a  Monte  Carlo  analysis  of  a 
GPS-aided  INS  Kalman  filter  design  as  seen  in  a  realistie  “truth  model” 
environment.  The  full-order  “truth  models”  and  redueed-order  “filter  design 
models”  are  presented  elearly  in  Chapter  3  of  this  thesis  study. 
a.  The  INS  will  not  have  the  usual  8-minute  ground  alignment.  That 
feature  eould  be  implemented  into  MatSOFE,  but  beeause  of  the  time 
eonstraints  it  is  left  as  a  future  addition  to  MatSOFE. 

in.  The  EN-93  INS  system  has  the  natural  ability  of  updating  the  vertieal 
ehannel  with  barometrie  altimeter  output.  MatSOFE  refleets  that  eharaeteristie 
as  well.  The  use  of  barometrie  altimeter  is  ineluded  in  the  modeling  of  the 
system,  so  that  the  INS  platform  is  assumed  to  be  stabilized  with  a  barometric 
altimeter.  Without  a  vertical  channel  aiding  device,  the  INS  vertical  channel  is 
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unstable.  In  fact,  using  a  barometric  altimeter  as  a  vertical  channel  aid  is  not 
the  only  option,  but  it  is  the  cheap  and  the  most  commonly  used  method. 
Unlike  GPS  aiding,  it  is  not  vulnerable  to  jamming  or  spoofing. 
iv.  Also,  the  barometric  altimeter  is  assumed  to  be  good  up  to  80,000  feet 
altitude.  Rapid  altitude  change  during  the  launch  is  expected,  and  at  80,000 
feet  the  baro-altimeter  will  be  turned  off  (in  simulations,  that  happens  almost 
at  53  seconds). 

V.  The  computer-simulated  Atlas  HAS  launch  vehicle  profile  is  generated 
by  using  the  software  “PROFGEN”  [29].  PROFGEN  has  been  developed  to 
work  with  MatSOEE  [12]  to  provide  the  necessary  data  files  to  simulate 
rocket  dynamics.  The  actual  total  flight  hour  for  the  Atlas  is  just  about  4000 
seconds  up  to  perigee  entrance.  For  simplicity  and  saving  computer  memory, 
the  flight  lasts  until  second  main  engine  cut  off  (MEC02).  In  fact,  at  about 
500  seconds,  the  rocket  is  on  the  orbit  and  after  that  point  it  makes  the  perigee 
entrance  maneuver.  The  MatSOEE  and  PROFGEN  are  presented  in  Chapter  3 
of  this  study  in  details. 

vi.  In  the  constructed  cases,  it  is  assumed  that  there  will  be  no  GPS 
measurement  outage  or  failure,  because  in  a  space  vehicle  INS  and  GPS 
systems  will  always  be  redundant.  In  reality,  from  the  GPS  satellite  vehicles’ 
point  of  view  (i.e.,  with  respect  to  the  geometry  of  the  satellites  and  receiver 
onboard  the  rocket),  GPS  data  will  almost  always  be  available  for  EEO  space 
vehicles. 
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vii.  A  4.0  nm/hr  CEP  INS  is  assumed  as  representative  of  a  “miero 
electromagnetic  system  (MEMS)”  INS.  Actually  nowadays,  their  accuracy  is 
almost  6.0  nm/hr  CEP,  but  when  this  thesis  is  finished,  or  shortly  thereafter,  it 
is  probable  to  have  MEMS  INS  units  with  4.0  nm/hr  CEP  accuracy.  0.4  nm/hr 
CEP  and  2.0  nm/hr  CEP  INS’s  represent  current  higher  and  medium  accuracy 
INS’s  respectively. 

via.  A  sample  period  of  one  second  has  been  chosen  for  the  EKE.  As  a 
matter  of  fact,  the  decision  to  use  a  one-second  sample  period  is  based 
primarily  on  the  typical  availability  of  the  GPS  measurement  in  the  real  world. 
The  sample  period  refers  to  how  often  the  GPS  measurements  will  be  brought 
into  the  EKE.  The  United  States  Coast  Guard  Navigation  Information  Service 
Bulletin  Board  distributes  post-fit  ("precise")  GPS  orbital  ephemeredes 
("orbits")  computed  by  National  Oceanic  and  Atmospheric  Administration’s 
(NOAA)  National  Geodetic  Survey  (NGS)  in  two  formats.  These  formats  are 
known  as  EE  18  and  SP3.  EE  18  is  a  binary  file,  while  SP3  is  its  ASCII 
equivalent  [32].  Usually,  the  GPS  EE  18  and  SP3  almanac  files  used  in  this 
study  are  stored  ever  15  minutes  or  at  a  higher  sample  period,  and  they  need  to 
be  converted  to  a  different  format  to  alter  the  sample  period.  The  one-second 
period  of  GPS  data  used  in  this  thesis  is  obtained  by  means  of  the  software 
used  to  convert  EE  18  data  format  into  SP3  data  format.  Though  faster  GPS 
outputs  are  available  via  “utility  software”  [32],  a  one  second  sample  period  is 
chosen  as  a  good,  representative  design  choice. 
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ix.  The  computer  simulations  have  been  developed  using  a  program  called 
MatSOFE,  which  has  been  updated  and  upgraded  by  the  author.  MatSOFE  is 
the  Matlab  [37]  version  of  the  Eortran-based  Multi-mode  Simulation  for 
Optimal  Eilter  Evaluation  (MSOEE)  [30].  MSOEE  is  well-established  Air 
Force  software  to  develop  and  test  linear  and  extended  Kalman  filter 
algorithms. 

X.  The  sv  ephemeris  data  using  WSEM  3.6  software  program  was 
downloaded  from  the  ARINC,  Inc.  web  page[2].  The  ephemeris  data  is  then 
post-processed  by  the  utility  software  programs  obtained  from  NOAA’s 
National  Geodetic  Survey  web  page  [32]  . 

xi.  Only  four  GPS  satellites  were  modeled  in  MatSOFE.  In  real-world 
applications,  depending  on  the  receiver  position  on  Earth,  most  likely  6-8 
satellites  would  be  visible  at  a  certain  time  epoch.  Four  SV  are  always 
available.  The  SEM  3.6  software  selects  the  four  best  satellites  available  at  a 
given  time  based  on  an  average  Position  Dilution  of  Precision  (PDOP)  less 
than  1.3  and  these  satellites  are  used  without  interruptions. 

xii.  The  MatSOFE  runs  are  conducted  using  15-run  Monte  Carlo  analyses. 
While  a  larger  batch  size  for  the  Monte  Carlo  analysis  would  be  preferable, 
this  value  has  been  chosen  to  keep  the  computational  burden  of  the  thesis 
within  reasonable  bounds,  while  maintaining  adequate  confidence  that  the 
resulting  sample  statistics  properly  reflect  the  true  statistics  [10]. 

xiii.  Flight  segment  durations  and  accelerations  of  the  real  launch  vehicle 
were  accurately  incorporated  in  order  to  generate  the  Atlas  profile 
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realistically.  It  is  also  assumed  to  be  launched  from  Cape  Canaveral  AS, 
SLC-41(28.5°  A,  81.0°IC  ).  Available  orbit  inclinations  for  that  location  are 

28.5°  -55.0°  and  polar  90.0° .  The  author  picked  28.5°  inclination  orbit  as  a 
fair  choice. 

xiv.  Taylor  series  approximations  truncated  at  first  order  are  used  for 
linearizing  nonlinear  equations  in  the  Space  Navigation  System  Model 
(SNSM)  filter.  See  Figure  1-6  for  SNSM  computer  model.  The  SNSM  is 
presented  in  detail  Section  3.5  of  this  study. 


Figure  1-6.  Space  Navigation  System  Model  (SNSM)  Simulation 
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1.6  Scope 

This  research  will  focus  on  a  simulation-based  tradeoff  analysis  study  of 
GPS/DGPS  integrated  with  a  baro-inertial  navigation  system  for  the  Atlas  HAS  launch 
vehicle.  The  study  of  designing  a  control  algorithm  for  a  launch  vehicle  could  also  be 
studied,  but  it  is  considered  as  the  follow-on  step. 

To  accomplish  the  tradeoff  performance  analysis  of  a  GPS-aided  INS  system,  one 
has  to  make  Monte  Carlo  simulations  and/or  covariance  analyses.  MSOFE  (Multimode 
Simulation  for  Optimal  Filter  Evaluation  (MSOFE)  software  [30])  is  restricted  for  use  by 
U.S.  government  agencies  and  their  U.S.  contractors.  In  order  to  accomplish  the  analyses, 
the  Matlab-based  [37]  “MatSOFE”  (first  created  by  former  AFIT  student  William  B. 
Mosle  [27]  in  1993  and  modified  by  Pamela  L.  Harms  [12]  in  1995  for  Sverdrup 
Technology,  Inc.,  TEAS  Group  and  finally  upgraded  and  modified  by  the  author)  is  used 
as  an  evaluation  software.  Not  being  a  compiled  language,  like  Fortran  or  C,  MATEAB 
causes  MATSOFE  to  be  almost  eight  times  slower  than  MSOFE.  This  means  long  run 
times.  (In  the  simulation  phase,  it  is  seen  that  a  15-Monte  Carlo-run  simulation  takes  8  to 
20  hours,  depending  on  the  processor  speed  of  the  computer  being  used.)  When  this 
constraint  is  taken  into  account,  accomplishing  only  the  navigational  aspect  of  a  space 
guidance,  navigation,  and  control  system  becomes  a  more  reasonable  scope  for  this 
research. 

The  tasks  involved  in  this  research  are  as  follows: 

1.  Review  prior  AFIT  theses  of  Negast  [33],  Mosle  [27],  Gray  [10],  Britton  [6], 
and  White  [44].  Investigate  the  INS/GPS  integrations  used  in  their  research. 
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2.  Conduct  a  literature  review  coneerning  the  latest  innovations  in  GPS  range 
resolution  and  reeent  INS/GPS  integration  teehniques. 

3.  Study,  and  if  necessary  restructure,  the  current  “truth  model”:  a  complete, 
eomplex  mathematieal  model  that  portrays  true  system  behavior  very 
aceurately.  Justify  its  sustained  use  and,  update  the  GPS/DGPS  information. 

4.  Make  any  adjustments  that  are  required  to  yield  an  aeeurate,  validated  model. 

5.  Further  validate  the  truthfulness  of  the  present  “truth  model”  by  comparing  it 
to  Litton-93  documentation  [18]. 

6.  Start  simple.  First  understand  the  basic  principles  of  the  provided  MatSOFE 
software. 

a.  Fill  the  gaps  of  the  provided  MatSOFE.  Add/rewrite  the  neeessary  m- 
files  (matlab  seript  files). 

b.  Eirst  generate  The  KC-135  Tanker  aireraft  flight  profile  by  using  the 
provided  PROE  IN  file  (the  input  file  of  PROEGEN  describing  the 
desired  maneuvers,  flight  segments,  accelerations,  ete  of  the  vehicle 
that  was  used  in  previous  researeh)  in  Gray’s  thesis  [10]. 

c.  Make  neeessary  changes  in  the  simulation  code  in  order  to  take  “true” 
GPS  measurement  data  evaluated  by  WSEM  3.6  software  into  the 
integrated  system.  Put  the  GPS  satellite  vehicle  ephemeredes  data  into 
a  format  that  Matlab  can  load  it  into  simulation. 

d.  Incorporate  the  UD  eovariance  faetorization  filter  principles  to 
propagation  and  measurement  update  cycles  in  order  to  increase  the 

numerieal  preeision  and  stability  in  the  Kalman  filter. 
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e.  Merge  FLY_OUT  (PFOFGEN  output  in  formatted  form)  and  SV_data 
(final  form  of  proeessed  GPS  satellite  vehiele  (SV)  measurements  in 
Litton  ECEF  eoordinates)  into  a  single  INPEIT  file  for  MatSOEE. 

7.  Compare  MatSOEE  results  to  Mosle’s,  Gray’s  and  Britton’s  MSOEE  results 
[6,10,27]  to  demonstrate  that  the  upgraded  MatSOEE  is  a  reliable  and  easy-to- 
leam  navigation  systems  performanee  evaluation  tool. 

8.  Carry  out  a  literature  review  to  deeide  upon  an  optimum  performance  launch 
vehicle  to  be  used  in  the  simulation.  Clearly  identify  the  characteristics  of 
launch  vehicle  to  generate  a  realistic  flight  simulation. 

9.  Perform  a  Monte  Carlo  analysis  for  each  suggested  case. 

10.  “Tune”  the  filter  to  provide  the  best  possible  performance. 

1 1 .  Analyze  each  case  and  compare  the  results  of  one  to  another. 

1. 7  Summary 

This  chapter  has  given  a  brief  overview  of  the  thesis  plan  to  develop  an 
integrated  GPS/DGPS,  INS,  and  Barometric  Altimeter  integrated  system  for  navigation 
of  a  rocket  launching  a  satellite.  The  background  for  the  necessity  of  such  a  system,  the 
various  system  integrations,  past  research,  the  project  scope,  and  all  assumptions  have 
been  presented.  The  reference  frames  used  in  this  research,  as  well  as  the  INS,  GPS, 
DGPS,  and  barometric  altimeter  subsystems  are  presented  in  Chapter  2,  along  with  a 
discussion  of  Kalman  filter  algorithms.  Chapter  3  introduces  MatSOEE  and  PROEGEN, 
and  presents  the  SNSM  system  and  filter  models.  Chapter  4  presents  the  results  and 
analysis  of  the  SNSM.  Chapter  5  presents  conclusions  and  recommendations. 
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//.  Theory 


2.1  Introduction 

The  background  presented  in  this  section  includes  the  basic  theory  on  a  ring  laser 
gyro  (RLG),  an  Inertial  Navigation  System  (INS),  a  Global  Positioning  System,  a 
Differential  Global  Positioning  System  (DGPS),  a  barometric  altimeter  and  a  radar 
altimeter.  Fundamental  Kalman  filter  and  extended  Kalman  filter  (EKF)  theory  will  also 
be  discussed.  More  information  on  Kalman  filter  development  and  uses  may  be  found  in 
[20,21,22].  Deterministic  and  stochastic  processes  used  in  this  section  will  be  presented 
in  roman  typeface.  Vectors  will  be  displayed  in  bold-faced  type,  x,  and  scalars  will  be 
shown  in  normal  type,  x.  Matrices  will  be  displayed  in  bold-faced  upper  case,  X,  A 
particular  realization  of  a  variable  will  be  displayed  in  italics,  x.  The  credit  for  the 
development  of  large  portions  of  this  chapter  belongs  to  Gray  [10]  and  Britton  [6]. 

2.2  Ring  Laser  Gyro  (RLG)  Strapdown  INS 

A  ring  laser  gyro  (RLG)  strapdown  INS  is  a  precision  navigation  system,  which 
provides  navigation  information  (position,  velocity,  attitude)  of  a  vehicle  using  inertial 
sensors,  such  as  gyroscopes  and  accelerometers  [17:  526].  “  Inertial  navigator  is  a  self- 
contained,  dead-reckoning,  navigation  aid  using  inertial  sensors,  a  reference  direction,  an 
initial  and/or  subsequent  fixes  to  determine  direction,  distance,  and  speed;  single 
integration  of  acceleration  provides  speed  information  and  a  double  integration  provides 


distance  information  [14].” 


A  strapdown  system  is  mechanized  by  mounting  three  gyros  and  three 
accelerometers  directly  to  the  vehicle  for  which  the  navigation  function  is  to  be  provided. 
More  than  three  of  each  can  be  used  to  provide  enhanced  reliability  through  redundancy 
(especially  in  a  space  navigation  system).  A  digital  computer  is  used  to  keep  track  of  the 
vehicle’s  attitude  with  respect  to  a  reference  frame,  based  on  the  information  from  the 
gyros.  This  enables  the  computer  to  provide  the  coordinate  transformation  necessary  to 
coordinatize  the  accelerometer  outputs  in  a  desired  computational  reference  frame,  such 
as  East-North-Up  (ENU)  or  wander  azimuth  (WA)  [6]. 

The  strapdown  system  is  a  specific  type  of  inertial  navigation  system 
characterized  by  lack  of  a  gimbal  support  structure  [5].  An  advantage  of  strapdown 
systems  over  the  gimbaled  is  that  a  strapdown  system  has  no  moving  platform  keeping  a 
“stable  element”  level.  Without  the  moving  parts,  the  system  is  less  prone  to  failures  and 
cheaper  to  build.  Also,  when  gyro  failures  occur  in  a  strapdown  system,  the  gyros  may 
be  replaced;  the  entire  inertial  measurement  unit  (IMU)  would  have  to  be  replaced  in  a 
gimbaled  system.  The  disadvantage  with  a  strapdown  system  is  that  the  platform  is 
physically  strapped  to  the  aircraft  body.  This  forces  the  gyroscopes,  accelerometers,  and 
strapdown  computer  algorithms  to  be  rugged  enough  to  maintain  integrity  in  whatever 
harsh  dynamic  environment  the  aircraft  may  encounter.  The  sensors  must  also  provide 
precise  measurements  over  a  substantially  larger  range  of  values  than  would  a  similar 
sensor  on  a  gimbaled  platform.  [6,10] 

REG  construction  basically  consists  of  an  optical  cavity,  a  laser  device,  three  or 
four  mirrors,  a  prism,  and  a  pair  of  photo  detectors.  To  provide  navigation  information, 
the  REG  detects  and  measures  angular  rates  by  measuring  the  frequency  difference 
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between  two  counter-rotating  (laser)  beams.  The  two  laser  beams  circulate  in  a  ring- 
shaped  optical  cavity  at  the  same  time.  The  beams  are  reflected  around  the  optical  cavity 
using  mirrors.  The  resonant  frequency  of  a  contained  laser  beam  is  a  function  of  its 
optical  path  length.  Since  the  path  traveled  by  each  of  the  beams  is  identical  when  the 
gyro  is  at  rest,  the  two  laser  beams  have  the  same  frequencies  under  these  conditions.  If 
the  cavity  is  rotating  in  an  inertial  sense,  the  propagation  times  of  the  two  light  beams  are 
different.  The  difference  in  the  propagation  time  reveals  itself  in  the  form  of  a  phase  shift 
between  the  two  beams,  and  a  pair  of  photo  detectors  detects  the  phase  shift.  The 
magnitude  of  the  phase  shift  provides  a  direct  indication  of  the  angular  rate  of  rotation  of 
the  instrument  with  respect  to  inertial  space  [6,10] 

2.3  Barometric  Altimeter 

The  inertial  sensors,  like  accelerometers  and  gyros,  used  in  INS  have  some  errors 
with  stochastic  properties.  These  errors  tend  to  increase  in  time  (long-term  instability) 
with  unbounded  position  error  growth,  and  require  occasional  compensation  [17:  526]. 
That  long-term  instability  results  in  unbounded  error  growth  in  vertical  position  and 
velocity.  By  means  of  aiding  the  vertical  channel  with  a  barometric  (or  other  type  of) 
altimeter,  the  instability  may  be  controlled  [6,3]. 

The  barometric  altimeter  is  probably  the  simplest  way  to  measure  the  altitude  of 
an  aircraft.  The  pressure  of  the  Earth’s  atmosphere  decreases  as  height  above  the  earth 
increases.  Barometric  altimeters  provide  altitude  information  based  on  the  pressure 
differences.  Barometric  altimeters  are  most  inaccurate  when  ascending  or  descending  at 
rapid  rates  but  are  relatively  low  in  cost  [6]. 


II-3 


As  mentioned  earlier  in  the  Assumptions  section  of  Chapter  I,  the  barometric 
altimeter  is  assumed  to  be  fully  functional  up  to  80,000  feet  altitude.  After  that  altitude, 
the  integrated  system  is  GPS-aided  fNS  alone.  So,  a  rapid  altitude  change  is  expected 
during  the  launch,  and  after  the  vehicle  passes  through  80,  000  ft,  some  degradation  in 
vertical  channel  precision  is  anticipated. 


2.4  Global  Positioning  System  ( GPS) 


GPS  is  a  passive,  space-based,  universal  and  accurate  source  of  navigation 


information  (three-dimensional  position  and  velocity)  and  time  system  that  has  three 


major  segments  as  seen  in  Figure  II-l;  Space  segment.  Control  segment,  and  User 


segment  [6,10,25,44]. 


Space  segment 

Uplink  data 

•  Sotellite  ephemeris  position  constants 

•  Clock-correction  factors 

•  Atmospheric  data 

•  Almanac  till 


Monitor 

stations 


Downlink  dato 

•  Coded  ranainq  siqnals 

•  Position  information 

•  Atmospheric  data 

•  Almonac 


User  segment 


Figure  11-1.  GPS  Major  Segments 
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2.4.1  GPS  Space  Segment 

The  GPS  Space  Segment  is  eomposed  of  24  or  more  aetive  satellites  in  six  orbital 
planes.  See  Figure  II-2.  The  satellites  operate  in  nearly  20,200  km  (10,900  NM)  orbits  at 
an  inelination  angle  of  55  degrees  and  with  ~  12-hour  period.  The  spaeing  of  satellites  in 
orbit  is  arranged  so  that  a  minimum  of  five  satellites  (more  likely  6-8  satellites)  will  be  in 
view  to  users  worldwide,  with  a  position  dilution  of  preeision  (PDOP)  of  six  or  less.  One 
of  the  main  properties  of  GPS  is  the  aehievable  preeision,  whieh  depends  not  only  on  the 
aeeuraey  of  the  pseudorange  measurements  but  also  on  the  geometry  of  the  transmitter 
and  the  reeeiver.  The  aeeuraey  of  measurements  ean  be  transformed  by  the  geometry 
from  a  pseudorange  aeeuraey  into  a  positioning  aeeuraey.  This  influenee  is  deseribed  by 
the  Dilution  of  Preeision  (DOP)  faetors.  Appropriate  signifieanee  is  given  to  the  field  of 
view  of  the  GPS  satellites  [1,  42].  PDOP  is  a  measure  of  the  error  eontributed  by  the 
geometrie  relationships  of  the  GPS  satellites  as  seen  by  the  GPS  reeeiver  [9].  PDOP  is 
mathematieally  defined  as: 

PDOP  =  ^(al+al+al)  (2.1) 

where  a] ,  <7^  and  a]  are  the  varianees  of  the  x,  y,  and  z  pseudorange  measurement- 

based  position  error,  respeetively.  A  definition  for  pseudorange  measurement  is  given  in 
Seetion  2.4.3.  Each  satellite  transmits  on  two  L  band  frequencies,  LI  (1575.42  MHz)  and 
L2  (1227.6  MHz).  LI  carries  a  precise  (P)  code  and  a  coarse/acquisition  (C/A)  code.  L2 
carries  only  the  P  code.  A  navigation  data  message  containing  the  important  information 
about  each  satellite  is  overlaid  on  these  codes.  The  same  navigation  data  message  is 
carried  on  both  frequencies  [10,34]. 
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Figure  11-2.  GPS  Orbital  Planes 
2.4.2  GPS  Control  Segment 

The  Control  Segment  has  six  USAF  monitor  stations,  three  of  whieh  have  uplink 
eapabilities.  See  Figure  II-3.  The  monitor  stations  use  a  GPS  reeeiver  to  traek  all  satellites 
in  view  passively  and  thus  aeeumulate  ranging  data  from  the  satellite  signals.  The 
information  from  the  monitor  stations  is  proeessed  at  the  Master  Control  Station  (MCS) 
to  determine  satellite  orbits  and  to  update  the  navigation  message  of  eaeh  satellite.  This 
updated  information  is  transmitted  to  the  satellites  via  the  ground  antennas,  whieh  are 
also  used  for  transmitting  and  reeeiving  satellite  eontrol  information.  The  speeifie 
funetions  of  the  Control  Segment  are: 

•  monitor  satellite  orbits  and  health 

•  maintain  GPS  time 

•  prediet  satellite  ephemeredes  and  eloek  parameters 

•  update  satellite  navigation  messages,  and 

•  eommand  small  maneuvers  of  satellites  to  maintain  orbit. 
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Colorado  Spiiiiss^ 

Master  Control 
Hawaii  Station  >. 

Monitor  Station 


Kwajalein 
Monitor  Station 


Figure  11-3.  GPS  master  control  &  monitor  stations 


2.4.3  GPS  User  Segment 

The  User  segment  consists  of  an  antenna  and  receiver  processors  that  provide 
positions,  velocity  and  precise  timing  to  the  respective  user.  Computing  the  user’s 
positional  information  typically  requires  simultaneous  solution  of  the  following  four 
nonlinear  position  equations  [6]: 


(Xj -uj^+{y,  -M„)"+(Zi -u^f  =(Ri -C^f 
(Xj  -wj"  +(y2  -u,,)"  +(Z2  ={K^-C^f 

(X3  -mJ"  +(y3  +(Z3 -u^f  =(R3 -Cgf 

(X4  -mJ"  +(y4  -M^)"  +(Z4 -u^Y  =(R4  -C^)" 

where  the  pseudorange,  Ri=i,2,3,4  to  oach  satellite  is  defined  as 

R[  =  cAtj 
R2  =  cSt2 
R3  =  cAt3 
R4  =  cAc 


(2.2) 


(2.3) 


and  c  is  speed  of  light 

'^ti=i,2,3,4  is  signal  transmit  time  as  measured  by  the  receiver 
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Xi=i,2,3,4,  yi=i,2,3,4,  Zi=i,2,3,4  are  respective  i-th  satellite  positions 
Mx,  My,  Mz  is  the  user  position  the  GPS  user  equipment  is  computing 
numerically  and  recursively 

Cb  is  the  user  clock  bias  (user  equipment  solves),  as  expressed  in 
equivalent  range  offset  in  Equation  (2.2). 

Normally  the  user  equipment  needs  to  acquire  and  maintain  lock  on  at  least  four 
satellites  in  order  to  compute  a  3-D  position  fix  u^,Uy  and  [24]  and  the  clock  bias  Cg. 

The  GPS  pseudorange  between  the  user  and  each  satellite  is  computed  based  on 
knowledge  of  time  (the  master  GPS  clock)  and  the  unique  signal  format,  which  is 
broadcast  by  each  satellite.  Part  of  the  problem  is  that  the  user  clock  is  not  identical  to 
the  master  clock.  Once  the  four  pseudoranges  are  known,  a  recursive  algorithm  is  solved 
to  compute  the  user’s  position  [24]. 

2.5  Differential  GPS  (DGPS) 

Differential  GPS  is  a  method  of  achieving  higher  GPS  positioning  accuracies  in  a 
local  area.  The  basic  principle  behind  DGPS  is  based  on  the  fact  that  pseudorange 
measurement  errors  are  correlated  between  two  nearby  receivers  tracking  a  given 
satellite.  A  single  DGPS  reference  station  at  a  known  location  can  compute  a  range  error 
correction  for  each  GPS  satellite  in  view.  The  error  corrections  may  then  be  broadcast  to 
users  in  the  vicinity  of  the  reference  receiver.  A  user  can  typically  improve  3-D 
positioning  accuracy  from  10  meters  (horizontal  DRMS)  for  a  standard  GPS  down  to  the 
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0.1-1  meter  level  by  applying  the  correetions  to  the  signals  received  [34],  The  accuracies 
do  decrease  as  the  distance  between  the  user  and  the  reference  station  increases. 

Work  accomplished  by  William  Negast  [33]  at  AFIT  has  demonstrated  the 
effectiveness  of  using  differential  corrections  to  increase  GPS  precision.  He  was  able  to 
eliminate  the  satellite  vehicle  (SV)  clock  error  from  each  pseudorange  measurement,  and 
the  SV  position  errors  were  nearly  eliminated.  The  atmospheric  propagation  errors  can 
be  almost  totally  eliminated  when  the  two  GPS  receivers  are  within  200  miles  of  each 
other  [33].  The  work  by  Negast  [33]  provided  the  new  DGPS  error  model  used  in  this 
effort.  Detailed  equations  for  DGPS  and  explanations  for  the  errors  removed  from 
standard  GPS  after  the  application  of  DGPS  corrections  are  presented  in  Section  3. 6. 2.2 

2.6  Reference  Frames 

A  navigation  "solution"  has  significance  only  if  the  corresponding  frame  in  which 
the  solution  is  expressed  is  clearly  understood  [36].  While  the  preceding  statement  may 
seem  obvious,  it  cannot  be  overemphasized.  Consider  that  a  typical  INS  "owner’s 
manual"  defines  earth  frame,  true  frame,  computer  frame,  platform  frame,  sensor  frame, 
accelerometer  frame  and  the  body  frame  [36,5].  From  a  student’s  perspective  this  may  at 
first  be  overwhelming,  but  to  make  matters  worse,  another  INS  vendor  may  well  define 
every  frame  mentioned  above,  such  as  "earth  frame"  in  an  entirely  different  manner! 
Therefore,  the  frames  used  in  this  project  and  the  coordinate  transformations  will  briefly 
be  discussed. 

Two  variants  of  a  five-frame  set  (inertial,  earth,  geodetic,  wander-level,  and  body) 
are  implemented  in  PROFGEN  (See  Figure  11-4).  One  variant  is  called  Standard 
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Navigation  Units  (SNU)  and  is  the  frame  set  used  in  the  USAF.  The  other  variant,  whieh 
is  called  World  Geodetic  System  (WGS),  was  added  to  PROFGEN  in  1999.  In  this 
research  the  WGS  reference  coordinate  system  is  preferred  in  PROFGEN,  but  the  Eitton 
reference  coordinate  system  is  used  in  MatSOEE,  because  the  EN-93  INS  mechanization 
has  been  defined  in  this  reference  system  [18].  Eor  instance,  the  true  GPS  ephemeredes 
data  are  in  the  WGS  84  “earth-centered-earth-fixed”  (ECEE)  reference  frame  but  the  EN- 
93  INS  uses  the  “Eitton  ECEE”  reference  system.  As  a  matter  of  fact,  the  transformation 
from  WGS  to  Eitton  reference  system  is  accomplished  by  only  changing  the  axis 
orientation.  The  transformation  from  WGS  ECEE  to  Eitton  ECEE  is  as  follows: 


^Litton  WGS 


0  1  0 
0  0  1 
1  0  0 


(2.4) 


Figure  11-4.  Circle  Diagram  Relating  PROFGEN  Frames  [29] 


The  GPS  data  and  INS  data  are  merged  into  a  single  input  m-file  named  FLIGHT  and 
then  they  are  transferred  into  the  Eitton  ECEE  reference  frame  set  in  this  research. 
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2.6.1  Inertial  Frame  (  x  ‘ ,  y  ‘ ,  z  ‘ ) 


The  inertial  frame  for  this  researeh  is  an  orthogonal,  right-handed  eoordinate 
system;  its  origin  is  eoineident  with  the  earth’s  eenter-of-mass  and  the  frame  is  oriented 
as  follows.  The  (x‘,  z  )  plane  lies  in  the  earth’s  equatorial  plane  and  does  not  rotate  with 
respeet  to  the  fixed  stars.  The  y‘  axis  projeets  from  the  earth’s  eenter-of-mass  direetly 
through  the  North  pole. The  inertial  frame  is  depieted  by  the  [x’,  y‘,  z]  frame  shown  in 
Figure  II-5  [10]. 


INERTIAL  FRAME  (  x  y  z  ‘ ) 


Figure  11-5.  Inertial  Frame 
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2.6.2  Earth  Frame  (x®,y®,z®) 


The  earth  frame  or  “earth-eentered-earth-fixed”  (ECEF)  frame  is  an  orthogonal, 
right-hand  eoordinate  system;  its  origin  is  coincident  with  the  earth’s  center-of-mass, 
with  the  (x*^,  z  )plane  located  in  the  earth’s  equatorial  plane.  The  z  axis  is  aligned  with 
the  Greenwich  meridian  and  rotates  at  exactly  the  earth  rate,  about  the  y*^  axis,  which 
projects  from  the  earth’s  center-of-mass  directly  through  the  North  pole.  The  Earth  frame 
is  depicted  as  [x®,  y®,  z®]  in  Figure  II-6  [10]. 
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2.6.3  Geographic  Frame  (  x  ^  ,  y  ^  ,  z  ^  )  =  (E,  N,  U) 


The  geographic  frame  or  “local-level”  frame  is  an  orthogonal,  right-handed 
coordinate  system;  its  origin  is  at  the  location  of  the  INS  (or  the  user),  and  its  axes  are 
aligned  with  the  East,  North  and  Up  directions  [E,  N,  U].  The  geographic  frame  remains 
perpendicular  to  the  earth’s  surface  with  respect  to  the  earth’s  gravity  field  as  the  user 
moves  over  the  Earth.  The  geographic  frame  is  depicted  as  either  [x®,  y®,  z®]  or  [E,  N,  U] 
in  Eigure  II-7. 


GEOGRAPHIC  FRAME  (  x  s,  y  s,  z  s  )  =  (  E,  N,  U  ) 


Figure  11-7.  Geographic  Frame 
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2.6.4  Navigation  Frame  (x“,y“,z“) 

The  navigation  frame  or  “loeal-level-wander-azimuth”  frame  is  an  orthogonal, 
right-hand  eoordinate  system;  its  origin  is  at  the  loeation  of  the  INS  (or  the  user).  It  is  the 
intended  eoordinate  frame  for  used  by  the  navigation  system  internal  eomputations.  This 
frame  eoineides  with  the  geographie  frame  when  the  wander  angle,  a,  equals  0°.  The 
wander  angle  is  a  eomputed  angle  between  a  “seribe  mark”  on  a  wander  azimuth  angle 
platform  and  North.  For  gimbaled  systems,  the  platform  is  purposely  not  eommanded  to 
seek  North,  due  to  the  high  platform  angular  rates  that  this  would  require  in  polar  regions, 
with  resulting  performanee  degradation  [6,3,36].  The  navigation  frame  is  denoted  as  [x“, 
y",  z"]  shown  in  Figure  II-8. 


LOCAL  LEVEL,  WANDER  AZIMUTH,  NAVIGATION  FRAME  (  x  ",  y  ",  z  " ) 


Figure  11-8.  Navigation  Frame 
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2.6.5  Body  Frame  (x*’,y'’,z*’) 


The  body  frame  is  an  orthogonal,  right-hand  frame;  its  origin  is  at  the  vehiele  (i.e., 
aireraft)  center-of-mass.  Its  axes  are  the  vehiele’s  roll,  piteh,  and  yaw  axes.  The  x'^  axis 
points  in  the  forward  direction,  along  the  roll  axis;  the  y'’  axis  points  to  the  right 
(starboard  side)  of  the  vehicle,  perpendicular  to  the  roll  axis,  but  along  the  pitch  axis;  and 
the  z  axis  is  positive  out  the  underside  of  the  vehicle.  The  body  frame  is  denoted  as  [x’’, 
y’’,  z*’]  and  is  shown  in  Figure  II-9. 


Figure  11-9.  Body  Frame 
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2. 7  Reference  Frames  Transformations 

The  RLG  INS  modeled  in  this  thesis  uses  the  navigation  frame  or  “loeal-level- 
wander-azimuth”  frame.  It  is  often  neeessary  to  express  veetors  sueh  as  position, 
attitude,  veloeity  or  aeeeleration  in  terms  of  several  different  referenee  frames.  As  an 
example,  the  INS  modeled  in  this  thesis  also  outputs  position  error  in  terms  of  an  error- 
angle  veetor,  [50x,  50y,  50z,  5h]^,  where  50x  is  the  error  angle  about  the  loeal  level  x®  (or 
E)  axis,  50y  is  the  error  angle  about  the  loeal  level  y®  (or  N)  axis,  50z  is  the  error  about  the 

loeal  level  z®  (or  U)  axis,  and  5h  is  the  altitude  error  [3,18].  Even  though  this  definition 
is  elear,  if  the  error-angle  veetor  is  to  have  physical  meaning,  it  must  be  transformed  into 
a  veetor  in  navigation  error  terminology,  [5(|),  5X,  5a,  5h]^,  where  5(|)  is  the  error  in 
latitude,  5X  is  longitude  error,  5a  is  alpha  (wander)  angle  error  and  5h  is  again  the 
altitude  error. 

A  transformation  matrix,  ^  permits  eompaet  transformation  of  the 

error-angle  veetor  into  an  equivalent  expression  in  navigation  error  spaee.  The 
transformation  matrix,  C^rwrTngle^’^^^’'  shown  below  in  Equation  (2.5)  [3,36]; 


f  Navigation  Error 
Error  Angle 


-cos  a 
sin  asee  (j) 
-  sin  crtan  (p 
0 


sma 

cosascc^ 
-cos  aiding 
0 


0 

0 

1 

0 


0 

0 

0 

1 


(2.5) 


(|)  =  latitude 
a  =  wander  angle 


Other  transformations  are  as  follows  (from  [6]): 
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2. 7.1  Inertial  Frame  to  Earth  Frame,  C.‘ 


cr  = 


cos  0  -  sin  Q.t 

0  1  0 

sin  Q.t  0  cos  Q.t 


(2.6) 


Note  that,  when  t  =  0,  x-axis  of  ECEF  frame  equals  x-axis  of  inertial  frame 

2. 7.2  Earth  Frame  to  Geographic  Frame, 


1  0  0 
Cf  =  I  0  cos(^  -sin^^ 
0  sin^^  cos(^ 


cos  A  0  -sin  A 
0  1  0 

sin  A  0  cos  A 
cos  A  0  -sin  A 

-sin^sinA  cos^  -sin^^eosA 
eos^sin/l  sin^^  cos^^eosA 

A  =  longitude 
(|)  =  latitude 
a  =  wander  angle 

2.7.J  Earth  Frame  to  Navigation  Frame,  C” 


where 


(2.7) 


C”  = 


coscr 

sincr 

0 

1 

0 

0 

cos /I 

0 

-sin /I 

-sincr 

coscr 

0 

0 

cos<z> 

-sin^ 

0 

1 

0 

0 

0 

1 

0 

sin^ 

cos<Z> 

sin /I 

0 

cos /I 

cos  crcos  A  -  sin  crsin  ^sin  A  sin  crcos  0  -  cos  crsin  A  -  sin  crsin  0  cos  A 
-sincrcos/l-coscrsin^sin/l  coscrcos<z>  sincrsin/l-coscrsin^cos/l 

cos<Z>sin/l  sin^  cos^cosA 


where 


A  =  longitude 
(|)  =  latitude 
a  =  wander  angle 


(2.8) 
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2. 7.4  Geographic  Frame  to  Navigation  Frame,  C” 


_ 


cos  a  sin  a  0 
-  sin  a  cos  a  0 
0  0  1 


(2.9) 


where 

a  =  wander  angle 


2.7.5  Geographic  Frame  to  Body  Frame,  C 


b 

g 


"1 

0 

0 

eos^ 

0 

-sin0 

cos^^ 

sinx// 

o' 

"0 

1 

0  ■ 

0 

eosyO 

sin  p 

0 

1 

0 

-sin^// 

cosx// 

0 

1 

0 

0 

0 

-sin  p 

COSyO 

sin0 

0 

cos^ 

0 

0 

1 

0 

0 

-1 

cos^sin^^ 

sin  /7sin  0sin  Xj/  +  cos  /7cos  Xj/ 
cos  yOsin  0sin  Xj/  -  sin  /7cos  y/ 


cosdcosx/  sin0 

sin /7sin  0COS  -  cos  yOsin  -sinyOcos^ 

cos  yOsin  ^cos  +  sin  yOsin  -cosyOcos^ 


(2.10) 


where 

p  =  roll 
0  =  pitch 

\|/  =  geographic  heading 

Actually,  the  rightmost  3x3  matrix  of  the  transformation  first  transforms  from  ENU 

g 

orientation  to  NED,  then  the  Navigation-to-Body  transformation  is  aecomplished. 
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2. 7. 6  Navigation  Frame  to  Body  Frame,  C 


b 

n 


"1 

0 

0 

cosff 

0 

-sinff 

cos  y^p 

sin^p 

0“ 

"0 

1 

0  “ 

0 

cos  p 

sin  p 

0 

1 

0 

-  sin  y/p 

cosy/p 

0 

1 

0 

0 

0 

-sin  p 

cos  p 

sinff 

0 

cosff 

0 

0 

1 

0 

0 

-1 

(2.11) 

cos  ^sin  y/p  cos  ^cos  y/p  sin  6 

sin  yOsin  ^sin  y/p  +  cos  /?cos  y/p  sin  /7sin  ^cos  y/p  -  cos  /7sin  y/p  -  sin  />cos  6 

cos  yOsin  ^sin  y/p  -  sin  yOcos  y/p  cos  yOsin  ffcos  y/p  +  sin  yOsin  y/p  -  cos  yOcos  6 


where 


p  =  roll 
0  =  piteh 

y/p  =  platform  heading  {y/p  =  y/  +  a) 


2.8  Kalman  Filter  Theory 

2.8.1  What  is  a  Kalman  Filter? 

A  Kalman  filter  is  simply  an  optimal  reeursive  data  proeessing  algorithm  [20]  that 
can  be  shown  to  be  optimal  by  essentially  any  standard,  given  the  appropriateness  of 
several  underlying  assumptions.  These  assumptions  are  that  the  system  in  question  can 
be  adequately  modeled  as  linear  with  white,  Gaussian  system  and  measurement  noises. 

One  aspect  of  the  word  "optimal"  is  that  the  Kalman  filter  can  incorporate  all 
information  (measurements)  provided  to  it  [20].  It  processes  all  available  measurements, 
regardless  of  their  precision,  to  estimate  the  current  value  of  the  variables  of  interest  with 
use  of  (from  [20]): 

•  Knowledge  of  the  system  dynamics  and  measurement  device 
characteristics. 
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•  The  statistical  description  of  the  system  noises,  measurement  errors  and 
uncertainty  in  the  dynamics  models. 

•  Any  available  information  about  initial  conditions  of  the  variables  of 
interest. 

For  example,  to  determine  the  velocity  of  an  aircraft,  one  could  use  a  Doppler 
radar,  or  the  velocity  indications  from  an  inertial  navigation  system,  or  the  pitot  and  static 
pressure  and  relative  wind  information  in  the  air  data  system.  Rather  than  ignore  any  of 
these  outputs,  a  Kalman  filter  could  be  built  to  combine  all  this  data  and  knowledge  of 
the  various  systems’  dynamics  and  sensor  attributes  to  generate  an  overall  best  estimate 
of  velocity.  Another  way  a  Kalman  filter  is  optimal  is  that  it  obtains  the  best  estimate  of 
desired  quantities  from  data  provided  by  a  noisy  environment.  Here  the  word  “optimal” 
means  that  the  Kalman  filter  minimizes  mean  squared  errors  and  is  optimal  with  respect 
to  essentially  all  other  criteria,  and  it  does  so  recursively.  The  word  recursive  means  that, 
unlike  certain  data  processing  concepts,  the  Kalman  filter  doesn't  require  all  previous  data 
to  be  kept  in  storage  and  reprocessed  every  time  new  measurements  are  taken. 

To  see  how  a  Kalman  filter  works,  a  simple  example  taken  directly  from  [20]  will 
be  presented.  It  is  included  here  because  it  helped  the  author  understand  the  concept  of  a 
Kalman  Filter  in  his  AFIT  studies.  Also,  the  credit  for  the  development  of  large  portions 
of  this  section  belongs  to  Gray  [10]  and  Britton  [6]. 

2.8.2  Kalman  Filter  Example 

Suppose  that  you  are  lost  at  sea  during  the  night  and  have  no  idea  at  all  of  your 
location.  So  you  take  a  star  sighting  to  establish  your  position  (for  the  sake  of  simplicity. 


11-20 


consider  a  one-dimensional  loeation).  At  some  time  you  determine  your  loeation  to  be 
Zj .  However,  beeause  of  inherent  measuring  device  inaccuracies,  human  error,  and  the 
like,  the  result  of  your  measurement  is  somewhat  uncertain.  Say  you  deeide  that  the 
precision  is  such  that  the  standard  deviation  (one-sigma  value)  involved  is  (or 

equivalently,  the  variance,  or  second  order  eentral  statistic,  is  Thus,  you  can 

establish  the  conditional  probability  of  x(h),  your  position  at  time  ty,  conditioned  on  the 
observed  value  of  the  measurement  being  zy ,  as  depieted  in  Figure  II- 10.  This  is  a  plot  of 
the  conditional  density  ^  (xjzj  )as  a  function  of  the  location  x:  it  tells  you  the 

probability  of  being  in  any  one  location,  based  upon  the  measurement  you  took.  Note 
that  is  a  direet  measure  of  the  uncertainty:  the  larger  is,  the  broader  the 

probability  peak  is,  spreading  the  probability  "weight"  over  a  larger  range  of  x  values. 

For  a  Gaussian  density,  68.3%  of  the  probability  "weight"  is  contained  within  the  band  o 
units  to  each  side  of  the  mean,  the  shaded  portion  in  Figure  II- 10. 


Figure  11-10.  Conditional  Density  of  Position  Based  on  Measured  Value  z1 
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Based  on  this  conditional  probability  density,  the  best  estimate  of  your  position  is 

x{h)  =  z,  (2.12) 

and  the  variance  of  the  error  in  the  estimate  is 

=  (2.B) 

Note  that  x  is  both  the  mode  (value  that  locates  the  peak)  and  the  median  (value  with  1/2 
of  the  probability  weight  to  each  side),  as  well  as  the  mean  (center-of-mass). 

Now  say  a  trained  navigator  friend  takes  an  independent  fix  right  after  you  do,  at 
time  ^2  =  h  that  the  true  position  has  not  changed  at  all),  and  obtains  a  measurement 

Z2  with  a  variance  .  Because  he  has  a  higher  skill,  assume  the  variance  in  his 

measurement  to  be  somewhat  smaller  than  in  yours.  Figure  II- 1 1  presents  the  conditional 
density  of  your  position  at  time  ^2  ?  based  only  on  the  measured  value  Z2 .  Note  the 
narrower  peak  due  to  smaller  variance,  indicating  that  you  are  rather  certain  of  your 
position  based  on  his  measurement. 


Figure  11-11.  Conditional  Density  of  Position  Based  on  Measurement  Z2  Alone 
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At  this  point,  you  have  two  measurements  available  for  estimating  your  position. 
The  question  is,  how  do  you  eombine  these  data?  It  ean  be  shown  that,  based  on  the 
assumptions  made,  the  conditional  density  of  your  position  at  ^2  =  h,  x  {12),  given  both 
Zj  and  Z2,  is  a  Gaussian  density  with  mean  |i  and  variance  (7^  as  indicated  in  Figure  11-12 
with 


Figure  11-12.  Conditional  density  of  position  based  on  data  Zi  and  Z2 
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Note  that,  from  (2.15),  a  is  less  than  either  or  whieh  is  to  say  that  the 

uneertainty  in  your  estimate  of  position  has  been  deereased  by  combining  the  two  pieces 
of  information. 

Given  this  density,  the  best  estimate  is 

x(t2)  =  ^  (2.16) 

with  an  associated  error  variance  CJ^ .  It  is  the  mode,  the  median  and  the  mean  (or,  since 
it  is  the  mean  of  a  conditional  density,  it  is  also  termed  the  conditional  mean). 
Furthermore,  it  is  also  the  maximum  likelihood  estimate,  the  weighted  least  squares 
estimate,  and  the  linear  unbiased  estimate  with  variance  that  is  less  than  that  of  any  other 
linear  unbiased  estimate.  In  other  words,  it  is  the  "best"  you  can  do  according  to  just 
about  any  reasonable  criterion. 

After  some  study,  the  form  of  |l  given  in  (2.14)  makes  good  sense.  If  were 

equal  to  ,  which  is  to  say  you  think  the  measurements  are  of  equal  precision,  the 

equation  says  the  optimal  estimate  of  position  is  simply  the  average  of  the  two 
measurements,  as  would  be  expected.  On  the  other  hand,  if  were  larger  than  , 

which  is  to  say  that  the  uncertainty  involved  in  the  measurement  Zj  is  greater  than  that  of 
Z2,  then  the  equation  dictates  "weighting"  Z2  more  heavily  than  Zj.  Finally,  the  variance 
of  the  estimate  is  less  than  even  if  is  very  large:  even  poor  quality  data  provides 

some  information,  and  should  thus  increase  the  precision  of  the  filter  output. 

The  equation  for  x{t2  )can  be  written  as 
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or  equivalently  as: 


^(^2)  =  ^1  + 


(j:  +  (j: 


[^2  -^1] 


(2.18) 


or,  in  final  form  that  is  aetually  used  in  Kalman  filter  implementations  (noting  that 

X(fi)  =  Zj), 

x{t2 )  =  x(h )  +  K (^2 )[Z2  -  x(h )]  (2.1 9) 


where 


K{t2) 


(2.20) 


These  equations  say  the  optimal  estimate  at  ^2,  (^2  ),  is  equal  to  the  best 
predietion  of  its  value  before  Z2  is  taken,  x  ( ) ,  plus  a  eorreetion  term  of  an  optimal 
weighting  value  times  the  residual  differenee  between  Z2  and  the  best  predietion  of  its 
value  before  it  is  aetually  taken,  x  ( ) .  It  is  worthwhile  to  understand  this  "predietor- 
eorreetor"  strueture  of  the  filter.  Based  on  all  previous  information,  a  predietion  of  the 
value  that  the  desired  variables  and  measurement  will  have  at  the  next  measurement  time 
is  made.  Then,  when  the  next  measurement  is  taken,  the  differenee  between  it  and  its 
predieted  value  is  used  to  "correet"  the  predietion  of  the  desired  variables. 

Using  the  K{t2)  in  Equation  (2.20),  the  variance  equation  given  by  (2.15)  can  be 
rewritten  as 


o2(r,)=  ('1)  (2.21) 

Note  that  the  values  of  x(t2  )  and  (^2  )  embody  all  the  information  in  the  Gaussian 


density  / 


x(^2|z(A)>z(h) 


(x  Zj ,  Z2  ).  Stated  differently,  by  propagating  these  two  variables. 
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the  conditional  density  of  your  position  at  time  ^2 ,  given  Zj  and  Z2,  is  completely 
specified. 

Thus  we  have  solved  the  (static)  estimation  problem  example  from  [20].  This  will 
be  of  vital  importance  to  the  practicality  of  filter  implementation.  The  filter  is  plain  and 
simple,  “just  a  computer  program  in  a  central  processor  [20].”  If  the  reader  needs  a 
further  example  detailing  dynamics  and  propagations,  see  [20]. 

2.8.3  Linear  Kalman  Filter 

Whenever  possible,  a  system  will  be  modeled  as  a  set  of  linear  differential 
equations  of  the  form  [20]; 

x(0  =  F(0x(0  +  B(0u(0  +  G(0w(0  (2.22) 

where: 

X  =  "state"  vector  (n-dimensional) 

F  =  homogenous  state  dynamics  matrix  (n  x  n) 

B  =  control  input  matrix  (n  x  r) 

u  =  deterministic  control  input  vector  (  r-dimensional) 

G  =  driving  noise  input  matrix  (n  x  s) 

w  =  white  Gaussian  driving  noise  vector  (s-dimensional) 

Because  the  deterministic  control  term  B(t)u(t)  is  zero  in  this  research,  it  will  be 
ignored  hereafter.  The  expected  value  (i.e.  mean),  of  the  white  Gaussian  driving  noise 
vector,  w(t)  is: 

E{v/(t)}  =  t)  (2.23) 
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and  the  noise  strength  is  Q(t): 

E[vt(t)vt'^  (t  +  Tj\  =  Q(t)S(T)  (2.24) 

where  S{-)  is  the  Dirac  delta  function. 

While  Equation  (2.22)  is  written  in  terms  of  "whole"  value  state  variables,  the 
models  used  in  the  thesis  are  those  of  error  states.  This  choice  of  state  variable  results  in 
simpler  dynamics  equations  [5],  and  (2.22)  may  be  rewritten  as  [20]; 

6x(0  =  F(06x(0  +  G(0w(0  (2.25) 

where  \{t)  has  been  replaced  by  the  error  state  vector  and  all  other  quantities  retain 

their  previous  definitions.  The  topic  of  error  states  is  explored  more  fully  in  the  section 
on  extended  Kalman  filters. 

As  previously  stated,  the  Kalman  filter  incorporates  sampled-data  measurement 
information  from  external  measuring  devices.  Irrespective  of  the  type  of  measuring 
device,  the  equation  which  is  used  to  describe  linear  measurements  at  sample  time 
is  of  the  form  [3]; 

z(t,)  =  H(t,)x(t,)  +  v(t,)  (2.26) 

or,  in  the  case  of  error-state  models: 

6z(6)  =  H(6)6x(t,)  +  v(t,)  (2.27) 

where,  in  both  cases  above,  H  is  the  observation  matrix,  and  v  is  a  discrete -time  zero- 
mean  white  Gaussian  measurement  noise  vector  with  covariance  given  by  [20]; 
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(2.28) 


£{v((,)v"(r,)} 


R(^.)/or  t.=t. 
0  for  ^  t. 


The  Kalman  filter  "propagates"  the  error  state  and  its  eovarianee  from  the  instant 
in  time  immediately  following  the  most  reeent  measurement  update,  t/",  to  the  instant  in 
time  immediately  preceding  the  next  measurement  update,  by  numerical  integration 
of  the  following  equations  [20]; 

i(t/t.)  =  F(0  x(t/t.)  (2.29) 

P(t  /  ti)  =  F(OP(t !  ti)  +  P(t  /  t,)F^(0  +  G(0Q(0G^(0  (2.30) 


The  notation  for  x(t  /  t^  )  and  associated  error  covariance  P(t  /  )  indicate  the 

best  estimate  of  x  and  P  at  time  t,  based  on  measurements  through  time  ,  and  t  is  in  the 
interval  from  to  .  Initial  conditions  are  given  as 

x(t;)  =  x(t,/t,)  (2.31) 

P(t;)  =  P(t,/t,)  (2.32) 

as  provided  by  the  measurement  update  cycle  at  time  .  The  variables  and 
indicate  the  initial  and  final  times  for  each  integration  period,  respectively. 

After  propagation,  =  x(t.^j  /  tf  and  P(t,^i)  =  P(t,+i  /  tf  are  "updated" 
(meaning  that  state  estimates  are  revised,  based  on  new  measurement  information).  The 
pivotal  element  in  the  update  equations  for  sample  time  (rather  than  time  )  shown 
below  is  the  time-varying  Kalman  filter  gain  K(t;  ).  The  K(t;  )  matrix  assigns  "weights" 
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to  the  "measurement  residual"  (the  residual  eonsists  of  the  dijference  between  the  aetual 
measurement  and  the  filter's  predietion  of  the  measurement)  based  on  known 
measurement  noise  statisties  and  filter-eomputed  state  error  eovarianee  from  the  previous 
time  step.  This  proeess  is  designed  to  improve  the  estimate  of  eaeh  element  of  the  state 
veetor.  The  update  equations  are  [20]; 


K(t, )  =  P(t-  )H  ^  (t,  ){H(t,.  )P(t :  )H  "  (t, )  +  R(t, )]-' 
X{tl )  =  x{t;  )  +  K(t,.  ){z .  -  H(t.  )x(t. )]} 
P(t;)  =  P(tr)-K(OH(OP(tr) 


(2.33) 

(2.34) 

(2.35) 


Although  the  algorithm  shown  above  is  generally  applieable  to  any  problem 
whieh  lends  itself  to  a  Kalman  filtering  solution,  it  is  not  neeessarily  the  algorithm  whieh 
is  used  in  praetiee.  It  is  often  advantageous  to  use  a  form  of  the  algorithm  known  as  the 
U-D  faetorization  form  [20].  In  the  U-D  algorithm,  the  filter  eovarianee  matrix  is  not 
propagated  and  updated  as  a  single  square  array.  The  U  and  D  matriees  below 
representing  the  pre-  and  post-measurement  filter  eovarianees,  respeetively,  are  explieitly 
eomputed  instead  [20]; 


p(tr)  =  u(tr)D(tr)u(tr) 

(2.36) 

P(t+)  =  U(t+)D(t+)U(t+) 

(2.37) 

where  the  U  matriees  are  upper  triangular  and  unitary  (and  thus  eontain  ones  along  the 
main  diagonal),  and  the  D  matrices  are  simply  diagonal  [20].  This  form  offers  several 
advantages,  including  numerical  stability,  improved  precision,  and  guaranteed  non¬ 
negativity  of  the  computed  covariance's  eigenvalues  [20].  It  is  the  U-D  form  of  the 
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Kalman  filter  algorithm  which  is  implemented  in  the  MatSOFE  software  [12]  that  is  used 
in  this  research. 

2.8.4  Linearized  and  Extended  Kalman  Filter 

Not  all  problems  are  adequately  described  with  linear  systems  driven  by  white 
Gaussian  noise.  In  many  cases,  the  most  appropriate  model  is  nonlinear.  The  navigation 
problem  at  hand  falls  squarely  into  the  nonlinear  category  (at  least  for  the  measurement 
model).  Fortunately,  a  relinearized  method  exists  whereby  a  nonlinear  system  may  be 
treated  in  much  the  same  manner  as  a  linear  one  for  a  particular  class  of  problems. 
Suppose  that  the  nonlinear  system  may  be  described  by  [21]; 

x(0  =  f  [x(0,  u(0,  t]  +  G(0w(0  (2.38) 

In  this  case,  the  state  dynamics  vector,  f  [■,  •,  ■],  is  a  nonlinear  function  of  the  state  vector 
x(-),  the  control  input  (assumed  to  be  zero  in  this  research),  and  time  t.  The  white 
Gaussian  noise  is  defined  exactly  as  in  (2.23)  and  (2.24),  and  it  still  enters  the  dynamics 
model  linearly.  In  addition,  the  measurement  equation  may  also  be  a  nonlinear  function 
of  the  state  vector  and  time  [21]; 

z(h)  =  h[x(t,.),tj  +  v(t,)  (2.39) 

The  noise  vector  v  is  again  zero-mean,  white  and  Gaussian,  entering  the  measurement 
equation  linearly,  and  its  covariance  is  described  by  (2.28). 

Recalling  that  a  system  must  be  linear  in  order  to  satisfy  the  assumptions  upon 
which  a  conventional  Kalman  filter  is  based,  the  nonlinear  equations  (2.38)  and  (2.39) 
must  be  linearized.  The  following  approach  is  summarized  from  [21]; 
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1.  Assume  that  a  nominal  state  trajeetory,  may  be  generated  whieh  satisfies 


^nik)  =  ^n,  (2-40) 

and 

x„(0  =  f[x„(0,u(0,^]  (2.41) 

where  f  [-,  •,  ■]  is  speeified  in  (2.38),  and  u(t)=0. 

2.  The  “nominal”  measurements,  whieh  aeeompany  the  nominal  trajeetory,  are: 

z„(h)  =  h[x„(t,.),tj  (2.42) 

3.  The  “perturbation”  of  the  state  derivative  is  obtained  by  subtraeting  the  nominal 
trajeetory  from  the  original  nonlinear  equation: 

[x(0  -  x„(0]  =  f[x(0,u(0,t]  -  f[x„(0,u(0,t]  +  G(0w(0  (2.43) 

4.  The  equation  above  may  be  approximated  to  first  order  by  a  Taylor  series  expansion: 

<&(0  =  F[t;x„  (0]‘&(0  +  G(0w(0  (2.44) 

where  &(•)  represents  a  first-order  approximation  of  the  proeess  [x(-)  -  x„  (•)],  and 
F[t;  x^  (t)]  is  a  matrix  of  partial  derivatives  of  f  with  respeet  to  its  first  argument, 
evaluated  along  the  nominal  trajeetory  [21]: 

F[t;x„(0]  =  ^^^  ..  (2.45) 

dx  X  =  x„(t) 

5.  The  perturbation  measurement  equation  is  derived  in  like  fashion  and  is  expressed  as 

[21]; 

&(t, )  =  m  ;x„msxit)  +  y{ti)  (2.46) 
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where 


oh[x,^J 


^  =  ^niU) 


(2.47) 


With  the  “error-state”  model  (2.44)-(2.47)  in  hand,  it  is  possible  to  return  to  the  linear 
filtering  theory.  An  estimate  of  the  whole-valued  quantities  of  interest  is  obtained  from 
[21]; 

x  =  x^{t)  +  dx{t)  (2.48) 

The  expression  above  for  the  linearized  Kalman  filter  is  useful,  provided  that  the 
linearization  assumption  is  not  violated.  However,  if  the  nominal  and  “true”  trajectories 
differ  by  too  large  an  amount,  unacceptable  errors  may  result  [21].  It  is  for  this  reason 
that  extended  Kalman  filtering  is  useful  in  many  cases  for  which  perturbation  techniques 
alone  do  not  suffice.  Extended  Kalman  filtering  allows  for  relinearizing  about  newly 
declared  nominals  at  each  sample  time,  to  enhance  the  adequacy  of  the  linearization 
process,  and  thus  of  the  resulting  filter  performance  as  well  [21]. 

The  extended  Kalman  filter  equations  are  summarized  below.  The  reader  is 
referred  to  [21]  for  details  regarding  their  derivation.  The  assumed  measurement  model 
equation  for  an  extended  Kalman  filter  development  is  given  by  Equation  (2.39),  where 
v(-)  is  once  again  zero-mean,  white  and  Gaussian,  with  covariance  given  by  (2.28). 
Measurements  are  incorporated  into  the  extended  Kalman  filter  via  the  following  set  of 
equations  [21]; 

K(t, )  =  P(t :  )H  ^  [t, ;  x(t-  )]{H[t, ;  x(t :  )]P(t :  )H  "  [t, ;  x(t :  )]  +  R(t, )}"'  (2.49) 

x(t;)  =  x(t")  +  K(t,){z.  -h[x(t")fi.]}  (2.50) 
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P(C)  =  P(^r)  -K(^,)H[^,;x(^r)]P(^r) 


(2.51) 


where 


H[^,  ;x(h  )] 


oh[x,^,] 


dy^ 


x  =  x(tr) 


(2.52) 


The  state  estimate  and  covariance  are  propagated  from  to  by  integrating  the 
following  equations  [21]; 

k(t  /  ti)  =  f[x(t  /  t-),uit),t]  (2.53) 

P(t  /  ti)  =  F[t;x(t  /  t,)]P(t  /  t,)  +  P(t  /  t,)F^[t;x(t  /  t,)]  +  G(0Q(0G^(0  (2.54) 
where 


F[t;x(t/t.)] 


dx 


X  =  x(t/t.) 


and  the  initial  conditions  are: 


(2.55) 


x(t./t,)  =  x(t;) 

(2.56) 

p(t, /fi)  =  p(t+) 

(2.57) 

The  equations  shown  above  for  the  extended  Kalman  filter  are  programmed  into 
the  MatSOFE  shell  [12]  for  the  problem  defined  by  this  thesis.  It  is  the  fact  that  the 
extended  Kalman  filter  is  relinearized  about  each  successive  estimate  of  the  state 
x(t)which  “enhances  the  validity  of  the  assumption  that  deviations  from  the  reference 
(nominal)  trajectory  are  small  enough  to  allow  linear  perturbation  techniques  to  be 
employed”  [21]. 
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2.9  Summary 

This  chapter  has  presented  the  basie  theory  of  an  RLG-based  strapdown  INS, 

GPS,  DGPS,  and  barometrie  altimeter.  Referenee  frames  and  eoordinate  transformations 
used  in  this  thesis  have  also  been  defined.  A  Kalman  filter  example  from  [20]  was  given 
and  linear,  linearized  and  extended  Kalman  filter  fundamentals  were  diseussed  from 
[21].  The  purpose  of  this  ehapter  was  to  provide  a  flavor  of  Kalman  filtering.  Chapter  3 
will  deseribe  the  design  methodology  and  error  models  of  the  RLG-based  strapdown  INS, 
GPS,  DGPS,  and  barometrie  altimeter  used  in  this  thesis  for  MatSOFE  simulations.  More 
information  on  Kalman  filter  development  and  uses  may  be  found  in  [20,21,22]. 
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Ill,  Design  Methodology  and  Error  Models 


3.1  Overview 

This  chapter  describes  the  set-up  of  the  MatSOFE  computer  simulation  for  the 
Spaee  Navigation  System  Model  (SNSM)  error  model.  This  chapter  also  deseribes  the 
teehnique  used  to  determine  whieh  “real-world”  {true)  satellite  vehiele  (SV)  ephemeris 
data  was  used  during  MatSOFE  simulation.  A  brief  deseription  on  using  PROFGEN  [52] 
to  generate  a  transport  aireraft  profile  and  a  launeh  vehiele  flight  profile  will  also  be 
diseussed.  The  Tanker  profile  is  used  to  validate  the  simulation  tool  by  eomparing  results 
to  previous  researeh  results;  the  next  ehapter  describes  the  use  of  PROFGEN  to  generate 
a  satellite  launeh  roeket  trajeetory  for  this  effort.  As  with  Chapter  2,  the  baekground 
works  done  by  Gray  [10]  and  Britton  [6]  laid  the  foundations  for  large  portions  of  this 
ehapter.  The  eredit  for  the  development  of  large  portions  of  this  ehapter  should  be  given 
to  them. 

3.2  Introduction  to  MatSOFE 

The  name  "MSOFE"  is  an  aeronym  meaning  "Multimode  Simulation  for  Optimal 
Filter  Evaluation."  MSOFE  is  a  general-purpose,  multimode  simulation  program  for 
designing  integrated  systems  that  employ  optimal  Kalman  filtering  teehniques  and  for 
evaluating  their  performance  [29].  Its  general-purpose  eonstruetion  allows  specifie  user 
problems  to  be  simulated  more  quiekly  and  at  less  eost  than  without  its  use.  MSOFE  has 
been  designed  to  support  a  wide  variety  of  system  simulation  and  filter  evaluation  efforts. 
It  provides  two  major  operating  modes: 
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1)  Monte  Carlo  simulation:  to  generate  multiple  sample  time 
histories  of  system  truth  states,  filter  states,  and  filter  estimation  errors,  including 
nonlinear  effects;  usable  for  linear  and  extended  Kalman  filters; 

2)  Covariance  simulation:  to  generate  time  histories  of  the  second- 
order  statistics  (covariances)  of  system  truth  states,  filter  states,  and  filter  estimation 
errors,  under  the  assumption  of  linear  (or  linearized)  models. 

Monte  Carlo  and  covariance  simulation  modes  of  MSOFE  are  complementary  to 
one  another.  The  covariance  mode  can  generate  filter  performance  statistics  via  a  single 
run,  whereas  the  Monte  Carlo  mode  requires  several  sample  runs  (say,  15  or  more)  to 
generate  meaningful  statistics  for  a  given  scenario.  However,  the  covariance  mode  is 
limited  to  linear  (or  linearized)  systems,  whereas  the  Monte  Carlo  mode  can  represent 
nonlinear  as  well  as  linear  dynamic  and  measurement  processes.  In  addition,  the  Monte 
Carlo  mode  provides  better  visibility  into  the  detailed  workings  of  the  filter  models  and 
computation  processes,  and  can  easily  be  reduced  to  a  deterministic  mode  (by 
suppressing  noise  sampling)  when  required  [10,6]. 

MSOFE  has  been  the  primary  tool  used  in  the  design  and  evaluation  of  the 
Kalman  filters  by  AFIT  students  at  Wright-Patterson  AFB,  Ohio.  As  stated  earlier, 
MSOFE  is  restricted  to  use  by  U.S.  government  agencies  and  their  U.S.  contractors.  As 
an  international  officer,  the  author  is  not  eligible  to  use  MSOFE  in  the  role  of  a  tool  for 
Kalman  filter  evaluation.  For  that  reason  the  Matlab  based  [37]  “MatSOFE”  is  used  in 
this  research  to  conduct  navigation  performance  analysis  of  a  launch  vehicle.  MatSOFE 
was  first  created  by  former  AFIT  student  William  B.  Mosle  [27],  GE/93D,  in  1993  and 
modified  by  Pamela  F.  Harms  [12]  in  1995  for  Sverdrup  Technology,  Inc.,  TEAS  Group 
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most  recently  before  the  author  received  it.  Before  the  author  received  it,  MatSOFE  was 
the  analysis  tool  that  had  been  used  on  the  Exploitation  of  Differential  Global  Positioning 
System  (GPS)  for  Guidance  Enhancement  (EDGE)  Program  to  conduct  a  navigation 
performance  analysis  in  TEAS  group.  That  received  version  will  be  called  the  EDGE- 
version  MatSOEE  in  this  thesis. 

“MatSOEE  is  written  entirely  in  Matlab  [37]  code.  Matlab  is  an  interactive  system 
and  programming  language  for  general  scientific  and  technical  computation.  MatSOEE 
has  been  written  as  a  set  of  Matlab  scripts  and  functions  using  m-files.  The  m-file  is  a 
feature  of  Matlab  used  in  the  MatSOEE  tool”  [12].  This  feature  allows  the  user  to  execute 
sequences  of  commands  that  are  stored  in  files  with  separate  names  and  extension  of 
“.m”,  as  in  “Matsofe_m.m”  which  is  in  fact  an  m-file  in  which  the  filter  process  strength 
(Q)  and  measurement  noise  covariance  (R)  are  stated  along  with  all  the  constants  used  in 
simulation. 

MatSOEE  is  designed  only  for  Monte  Carlo  simulations.  It  does  not  have  the 
capability  of  making  a  covariance  analysis.  Such  a  capacity  could  be  added  to  MatSOEE 
performance  evaluation  as  well,  but  as  is  discussed  clearly  earlier,  the  covariance  analysis 
is  limited  to  linear  (or  linearized)  systems,  whereas  the  Monte  Carlo  simulations  can 
represent  nonlinear  as  well  as  linear  dynamic  and  measurement  processes.  Besides  that, 
the  “real  world”  is  itself  nonlinear  for  this  application.  15  runs  of  Monte  Carlo 
simulations  (unless  otherwise  noted)  are  made  in  this  research  by  using  MatSOEE. 

The  latest  version  MatSOEE  is  the  outcome  of  a  collective  effort.  Many  people 
struggled  to  reflect  their  knowledge  in  Matlab  and  Kalman  filtering  before  it  reached 
today’s  capabilities.  At  the  time  of  delivery,  the  EDGE  version  MatSOEE  had  53  m-files. 
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containing  a  48-state  strapdown  INS/GPS  model,  which  includes  21  states  for  INS  and  27 
states  for  GPS  (with  5  modeled  GPS  SV  errors)  along  with  a  17-state  filter  model.  It  had 
a  limited  capability.  The  GPS  orbit  model  was  a  fairly  simplistic  model  and  was  not  very 
realistic  for  anything  other  than  extremely  short  flight  trajectories  (less  than  two  minutes) 
During  this  research,  21  m-files  have  been  deleted,  18  new  m-files  have  been  added,  and 
almost  all  others  have  been  modified  to  be  adequate  for  a  realistie  launch  vehicle 
simulation.  Currently,  MatSOFE  has  a  69-state  (61 -state  for  DGPS)  LN-93  INS/GPS 
integration  truth  model,  whieh  includes  a  39-state  reduced  order  LN-93  INS  model  and 
30-state  GPS  (22-state  for  DGPS)  error  model.  The  filter  model  contains  13  states  (9 
states  for  Pinson  error  variables’  definition,  2  states  for  barometric  stabilization,  and  2 
states  for  GPS).  Unlike  the  EDGE  version,  it  uses  “simulated  true  GPS  data”,  and  the 
U-D  factorization  algorithm  in  order  to  inerease  the  numerical  stability  in  the  Kalman 
filter. 

Similar  to  MSOEE,  MatSOEE  permits  the  user  to  design  integrated  systems 
through  Kalman  filtering  techniques  and  provides  a  reliable  evaluation  tool  for  that 
purpose.  The  power  of  Matlab  makes  MatSOEE  an  excellent  software  tool  for  “realistic” 
implementation  of  Kalman  filter  performance  evaluation  tool  analogous  to  the  Eortran- 
based  MSOEE.  One  advantage  of  MatSOEE  is  that  it  is  capable  of  making  matrix 
operations  versus  the  Eortran-based  program,  MSOEE,  which  performs  scalar  operations. 
Additional  advantages  of  MatSOEE  include  access  to  data,  simplicity  of  programming, 
ease  to  build  models,  simplicity  to  obtain  outputs,  familiarization  of  AEIT  students  with 
Matlab  and  relative  ease  in  troubleshooting  and  debugging.  On  the  other  hand,  using  a 
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compiled  language  MSOFE  is  a  faster  and  well-established  Kalman  filter  performanee 
evaluation  tool. 

As  a  performance  evaluation  tool,  MatSOFE  (see  flow  chart  below)  first  takes  all 
the  constants  and  filter  tuning  parameters  (Qs,  Qf ,  Rs ,  Rf )  provided  by  the 
“Matsofe  in.m”  file.  In  the  “Setup2.m”  m-file,  all  the  desired  simulation  scope 
information  (simulation  time,  number  of  measurements  and  their  rates,  etc)  is  declared. 
“Tnitrun2.m”  sets  the  initial  conditions  (x(to),  P(tci)  and  simulation  time  controls 
initialization).  All  computations  (El-D  factorization,  propagation  and  update  cycles,  the 
process  of  storing  and  keeping  track  of  the  evaluated  parameters,  etc.,  takes  places  in  this 
m.file.  Probably  95%  of  the  simulation  time  is  consumed  in  “Simrun2.m”.  Endrun2  and 
Endsim.m  are  called  at  t  he  end  of  each  run  and  at  the  end  of  simulation  respeetively. 


Figure  III-1.  Block  Diagram  of  MatSOFE  Flierarchical  Structure 
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3.3  Introduction  to  PROFGEN 


PROFGEN  calculates  kinematic  data  for  a  simulated  air  vehiele  (aireraft,  missile, 
roeket)  moving  in  free  spaee  over  the  earth.  Kinematies  is  eoneerned  with  spaee  and  time, 
and  with  the  time  rate  of  change  of  quantities  that  describe  the  geometry  of  motion. 
Kinematie  data  inelude  translational  variables  like  position  and  veloeity,  and  rotational 
variables  like  angle  and  angular  rate,  whieh  portray  the  aireraft’ s  dynamie  state  [29]. 

PROFGEN  models  the  aireraft  as  a  point  mass  body.  There  are  no  aetuators,  no 
eontrol  surfaees,  no  aerodynamies,  and  no  propulsion  system.  Position  is  given  as 
(geographie)  latitude,  longitude  and  altitude.  Veloeity  with  respeet  to  earth  is 
eoordinatized  and  presented  in  a  loeal-vertieal  frame.  Aeeeleration  eonsists  of  veloeity 
rates-of-change  summed  with  Coriolis  effeets  and  gravity.  Attitude  consists  of  roll,  pitch 
and  yaw:  the  Euler  angles  [6].  PROFGEN  tool  utilities  are  stand-alone  interaetive 
programs  that  (mostly)  prompt  for  their  inputs.  To  use  PROFGEN,  one  must  supply  an 
input  file  that  speeifies  the  desired  trajeetory. 

PROFGEN  builds  a  complete  trajeetory  from  a  sequence  of  flight  segments,  one 
segment  following  another  in  time.  The  final  values  of  the  variables  for  segment  “k” 
beeome  the  initial  values  for  the  segment  “k+l”,  thereby  maintaining  eontinuous-time 
histories  for  all  output  quantities.  Eaeh  flight  segment  executes  one  “maneuver”  at  a  time, 
with  six  kinds  of  maneuvers  being  possible:  straight  flights,  rolls,  vertical  turns, 
horizontal  turns,  jinking  and  free  fall.  Sinee  it  eannot  do  several  maneuvers 
simultaneously,  PROFGEN  eannot  be  made  to  perform  intrieate  aetions  like  Tmmelmanns 
or  barrel  rolls.  This  will  be  limiting  for  some  applieations  [29].  Flight  segments  should 
not  exceed  53. 
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PROFGEN’s  kinematic  computations  track  the  motion  of  the  aircraft  in  six 
degrees  of  freedom  (6-DOF).  The  vehicle  may  move  anywhere  in  3-space  and  may 
achieve  any  attitude  except  vertical  flight.  The  vector  variables  can  be  output  in  any  of 
four  coordinate  frames  (inertial,  earth,  wander-level,  body).  Direction  cosine  matrices 
between  pairs  of  frames  can  also  be  output.  See  Table  III-l  for  PROFGEN  flight  profile 
outputs. 

PROFGEN  has  been  used  to  create  trajectories  for  a  variety  of  aircraft  including 
bombers,  fighters,  transporters,  and  helicopters.  But  it  is  also  able  to  produce  trajectories 
other  than  aircraft.  For  example,  it  has  been  used  to  simulate  missile  flights,  bombs  in 
free  fall,  satellites  in  Earth  orbit,  and  busses  driving  highways. 

For  this  study  the  latest  version  of  PROFGEN  (Version  8.1)  is  used  to  generate 
trajectories.  In  order  to  validate  MatSOFE  as  a  reliable  Kalman  filtering  performance 
evaluation  tool,  the  work  accomplished  by  Gray  [10],  Britton  [6],  and  Mosle  [27]  are 
regenerated  in  the  MatSOFE  environment.  To  do  this  job,  the  KC-135  Tanker  aircraft 
flight  profile  of  these  previous  research  efforts  is  generated  in  PROFGEN  by  using  the 
provided  PROF_IN  code  in  Gray’s  thesis.  After  MatSOFE  is  validated,  at  the  second 
stage,  the  Atlas  HAS  launch  profile  is  generated  in  PROFGEN.  The  Atlas  flight  profile 
has  8  flight  segments.  The  segments  for  the  “Tanker”  flight  profile  used  in  this  thesis  are 
shown  in  Table  III-2.  The  parameters  shown  in  Table  III-2  are  computed  by  the  author 
taking  the  actual  flight  characteristics  into  account.  Appendix  C  shows  the  Fortran- 
based  PROF  IN  file  for  the  Atlas  launch  vehicle  and  Figure  III-2  shows  the  plot  of  2- 
dimensional  PROFGEN-generated  rocket  profile. 
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Table  1 1 1-1  A.  PROFGEN  Flight  Profile  Outputs 


Printed 

Printed  to 

Printed  to 

# 

Variable  Name 

Dim 

Name 

FLY_OUT 

PROF_OUT 

0 

time 

1 

TIME 

YES 

YES 

1 

geodetic  longitude 

1 

GLON 

YES 

YES 

2 

geodetic  latitude 

1 

GLAT 

YES 

YES 

3 

altitude 

1 

ALT 

YES 

YES 

B 

celestial  longitude 

1 

CLON 

5 

wander  angle 

1 

ALPHA 

YES 

YES 

6 

heading 

1 

HEAD 

B 

roll 

1 

ROLL 

YES 

YES 

8 

pitch 

1 

PITCH 

YES 

YES 

9 

yaw 

1 

YAW 

YES 

YES 

10 

terrestrial  longitude  rate 

1 

dGLON 

11 

geographic  latitude  rate 

1 

dGLAT 

12 

altitude  rate 

1 

dALT 

13 

celestial  longitude  rate 

1 

dCLON 

14 

wander  angle  rate 

1 

dALPHA 

YES 

YES 

15 

heading  rate 

1 

dHDG 

16 

roll  rate 

1 

dROLL 

YES 

YES 

17 

pitch  rate 

1 

dPITCH 

YES 

YES 

18 

yaw  rate 

1 

dYAW 

YES 

YES 

19 

signed  earth  velocity  magnitude 

1 

Vs 

20 

signed  earth  velocity  magnitude  rate 

3 

dVs 

21 

position  in  frame  i 

3 

Ri 

22 

earth  velocity  in  frame  i 

3 

Vi 

23 

inertial  velocity  in  frame  i 

3 

Vli 

24 

gravitation  in  frame  i 

3 

GNi 

25 

specific  force  in  frame  i 

3 

Fli 

III-8 


Table  1 1 1-1 B.  PROFGEN  Flight  Profile  Outputs 


# 

Variable  Name 

Dim 

Printed  Name 

Printed  to 

FLY_OUT 

Printed  to 

PROF_OUT 

26 

angular  rate  b/i  in  frame  I 

3 

WbiJ 

27 

DCM  to  inertial  from  body 

3x3 

Cib 

28 

DCM  to  inertial  from  earth 

3x3 

Cie 

29 

angular  rate  e/i  in  frame  e 

3 

Wei_e 

30 

position  in  frame  e 

3 

Re 

31 

earth  velocity  in  frame  e 

3 

Ve 

32 

inertial  velocity  in  frame  e 

3 

Vie 

33 

gravity  in  frame  e 

3 

Ge 

34 

specific  force  in  frame  e 

3 

Fie 

35 

angular  rate  b/i  in  frame  e 

3 

Wbi_e 

36 

DCM  to  earth  from  body 

3x3 

Ceb 

37 

DCM  to  earth  from  wander-level 

3x3 

Cew 

38 

angular  rate  n/e  inframe  w 

3 

Wwe_w 

39 

position  in  frame  w 

3 

Rw 

40 

earth  velocity  in  frame  w 

3 

Vw 

YES 

YES 

41 

inertial  velocity  in  frame  w 

3 

Vlw 

42 

gravity  in  frame  w 

3 

Gw 

43 

specific  force  in  frame  w 

3 

Flw 

YES 

YES 

44 

angular  rate  b/i  in  frame  w 

3 

Wbi_w 

45 

DCM  to  wander-level  from  body 

3x3 

Cwb 

46 

DCM  to  wander-level  from  inertial 

3x3 

Cwi 

47 

angular  rate  b/w  in  frame  b 

3 

Wbw_b 

48 

position  in  frame  b 

3 

Rb 

49 

earth  velocity  in  frame  b 

3 

Vb 

50 

inertial  velocity  in  frame  b 

3 

VIb 

51 

gravity  in  frame  b 

3 

Gb 

52 

specific  force  in  frame  b 

3 

Fib 

53 

angular  rate  b/i  in  frame  b 

3 

Wbi_b 
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Table  1 1 1-2.  PROFGEN  Segments  for  "Atlas  HAS"  Flight  Profile 


MANEUVER  DEFINITION 

MAN. 

SEGLNT 

PACC 

TACC 

DELHED 

DELPIT 

DELRCL 

PD_DT 

FD_DT 

1 

Ground-lit  SRB  ignition 

and  liftoff 

Strt. 

1 

1 

0 

0 

0 

0 

1 

1 

2 

Ground-lit  SRB  burnout 

&  Air-lit  SRB  ignition 

Vert. 

60 

1.9 

0.5 

0 

-5 

0 

5 

1 

3 

Air-Lit  SRB  burnout 

and  jettison 

Vert. 

57 

0.25 

2.22 

0 

-20 

0 

5 

1 

Atlas  booster  engine 

cutoff  and  booster 

package  jettison 

Vert. 

50 

0.2 

2.22 

0 

-20 

0 

5 

1 

5 

Payload  fairing  jettison 

Vert. 

48 

0.18 

1.1 

0 

-5 

0 

5 

1 

6 

Sustainer  engine  cutoff 

Vert. 

85 

0.4 

1.3 

0 

-10 

0 

10 

1 

Atlas/Centaur 

seperation 

Vert. 

192 

0.3 

1.7 

0 

-20 

0 

50 

1 

8 

Centaur  main  engine 

cutoff  (MEC02) 

Vert. 

985 

0.3 

0.8 

0 

-10 

0 

50 

1 

MAN:  Maneuver  type 
SEGLNT:  Segment  length  (sec.) 

PACC:  Path  acceleration  (gees) 

TACC:  Turn  acceleration,  maximum  centrifugal  component  (gees) 

DELHEL:  Desired  change  in  heading  for  horizontal  turn  (deg.) 

DELPIT:  Desired  change  in  pitch  angle  for  vertical  turn  (deg.) 

DELROL:  Desired  change  in  roll  angle  for  roll  maneuver  (sec.) 

PO  DT:  Time  interval  between  synchronous  formatted  prints  to  PROF  OUT  (sec.) 
FO  DT:  Time  interval  between  synchronous  unformatted  writes  to  FLY  OUT  (-) 
Note:  These  definitions  are  extracted  from  the  PROFGEN  user  manual  [29] 
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Atlas  2-D  Flight  Profile 


Figure  III-2.  Atlas  2-Dimensional  Flight  Profile 


3.4  Satellite  Vehicle  Data  Using  WSEM  3.6 

The  PROFGEN  output  file,  FLY_OUT.ase,  simulates  and  provides  necessary 
variables  which  MatSOFE  needs  for  the  estimation  process.  Another  file  that  MatSOFE 
must  read  for  this  study  is  the  simulated  true  SV  ephemeris  data  (for  GPS  measurement 
simulations)  provided  by  the  information  obtained  from  [2,32  38]. 

At  AEIT,  for  the  first  time.  Gray  [10]  made  use  of  true  satellite  vehicles  (SV) 
ephemeris  data  as  an  input  to  MSOFE  rather  than  utilizing  the  MSOFE  subroutine  to 
generate  generic  SV  data.  The  System  Effectiveness  Model  for  Windows  (WSEM) 
software  program  is  part  of  a  wide-ranging  collection  of  engineering  tools  developed  to 
analyze  GPS  system  performance  and  mission  effectiveness. 
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The  WSEM  [2]  program  incorporates  a  simple  computer  model  of  the  GPS 
system.  This  software  system  model  includes  a  simulated  Earth  based  on  the  World 


Geodetic  System  1984  (WGS-84)  definitions.  It  also  includes  up  to  32  simulated  Navstar 
SVs  that  orbit  around  the  Earth  and  various  types  of  GPS  user  equipment  (UE  ) 
simulations  which  the  WSEM  operator  may  select  and  define  to  be  located  at  any  point  or 
set  of  points  on  or  near  the  simulated  Earth  surface.  As  part  of  its  GPS  system  model, 
WSEM  automatically  computes  the  current  Earth-centered,  Earth-fixed  (ECEE)  positions  of 
each  Navstar  SV  in  the  constellation  defined  by  the  selected  almanac  data  file.  "Almanac," 
as  used  here,  refers  to  a  set  of  orbital  parameters  that  define  where  a  satellite  is  and  where  it 
is  headed.  The  WSEM's  SV  almanacs  and  related  mathematical  algorithms  are 
implemented  exactly  as  in  the  actual  GPS  system,  except  that  provisions  for  geostationary 
satellite  almanacs  have  also  been  included.  Thus,  WSEM  is  compatible  with  the 
information  that  the  real  GPS  SVs  broadcast  on-orbit  [2]. 

The  “SEM  almanac”  used  in  this  study  is  obtained  from  the  National  Geodetic 
Survey(NGS)’s  continuously  operating  reference  stations  (CORS)  web  site  [32].  The  SV 
ephemeris  used  in  the  SNSM  simulation  was  selected  based  upon  the  best  four  SV 
available  for  a  random  day  (the  current  day  when  SEM  almanac  was  downloaded)  by  the 
WSEM  3.6  Software  [2].  The  four  SVs  chosen  were  based  on: 

•  Random  day  (28  July  2001)  selected. 

(GPS  week  1 124,  Day  of  year  209). 

•  GPS  Almanac  data  file  "072801A.AL3"  (See  Appendix  E)  was  obtained 
(downloaded)  from  United  States  Coast  Guard  web  sites  [32,  38]. 


Ill- 12 


•  LAT/LONG/ALT  along  the  Tanker  flight  profile  was  noted  and  entered 
in  WSEM  V3.6. 

•  Best  4  SV  based  on  PDOP  algorithm 

•  10°  mask  angle  (SV  visibility  rejection  criteria) 

•  Scenario  duration:  1  hour  [Begin  time  04:00  UTC 
(Coordinated  Universal  Time  or  08:00  Eastern  time)] 

The  best  four  SVs  are  then  numerically  displayed  to  the  user.  The  mask  angle  was 
chosen  as  10°  based  on  the  author’s  experience.  Thus,  all  satellites  in  view  above  a  10° 
angle  made  from  the  GPS  antenna  surface  (mask  angle)  on  28  July  2001  between  the 
hours  of  04:00  -  06:00  Greenwich  mean  time  are  available  for  use.  Eor  further 
information  on  SEM  3.6  software  and  the  SEM  3.6  output  plot  format,  see  [2]. 

3.5  The  SNSM  Computer  Model 

The  Eanding  System  Model  (ESM)  and  Differential  Eanding  System  Model 
(DLSM)  model  [10,6]  were  used  as  a  reference  to  model  the  Space  Navigation  System 
Model  (SNSM)  computer  model.  The  SNSM  is  divided  into  two  parts  for  computer 
modeling,  the  truth  model  and  the  filter  design  model.  The  truth  model  represents  the 
computer-generated  simulation  of  the  real-world  error  characteristics  found  in  avionics 
“black  boxes”  and  the  environment  in  which  the  units  operate.  The  research  was 
accomplished  through  computer  simulation;  therefore,  the  truth  model  will  simulate  the 
errors  in  true  avionics  hardware  (INS,  GPS/DGPS,  Baro,  Radar  Altimeter)  black  boxes. 
The  truth  model  generates  the  measurement  updates  for  the  SNSM  filter,  the  true  flight 
profile  of  the  aircraft,  and  a  state  variable  baseline  for  evaluating  filter  performance 
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[10,6].  Detailed  explanations  related  to  truth  model,  filter  model,  measurement  model, 
GPS  and  DGPS  error  models,  ete.  will  be  presented  in  Seetions  3.6.1  and  3.6.2.  The  truth 
model  eonsists  of  69  error  states  for  GPS-aided  INS  and  6 terror  states  for  DGPS-aided 
INS  about  their  nominal  values.  The  filter  model  represents  the  SNSM  as  it  eould  be 
hosted  on-board  an  aireraft  eomputer.  Briefly,  the  SNSM  filter  model  is  a  13 -state 
extended  Kalman  filter  developed  through  order  reduetion  of  the  original  93 -state  truth 
model  of  [27,33]  for  just  INS,  plus  30  more  states  for  GPS  (22  for  DGPS).  Section  3.6.1 
and  3.6.2  of  this  section  explains  INS  and  GPS  error  models  in  detail,  respectively.  An 
advantage  of  using  only  13  states  is  that  the  current  state-of-the-art  aircraft  host 
computers  can  handle  the  computational  requirements. 

The  block  diagram.  Figure  111-3,  explains  the  interaction  of  the  filter  and  truth 
model  in  MatSOFE.  A  simulated  flight  profile  is  provided  by  PROFGEN  [29],  and  the 
U.S.  National  Geodetic  Survey  (NGS)’s  continuously  operating  reference  stations 
(CORS)  web  page  [32]  provides  true  SV  ephemeris  data  for  any  SV.  Use  of  the  "real- 
world"  ephemeris  replaced  almost  six  of  the  prior  m-files  functions  used  in  old  versions 
of  MatSOEE.  The  best  four  SV,  which  have  the  best  (lowest)  position  dilution  of 
precision  (PDOP),  were  chosen  by  using  System  Effectiveness  Model  for  Windows 
(WSEM)  software  [2].  The  WSEM36  program  requires  GPS  almanac  files  to  run.  Current 
Almanac  files  can  be  found  at  the  ARINC  web  site  [2]  or  at  the  United  States  Coast 
Guard  web  sites  [32,  38].  With  this  information,  the  truth  model  is  able  to  simulate  a  real 
world  INS  navigation  solution,  x  -I-  SXjj^g  ,  and  generate  the  real  world  GPS/DGPS 
measurements,  Rqps  and  Rdgps  respectively.  The  Kalman  filter  block  in  Eigure  III-3 
represents  the  SNSM  filter.  Corrections  from  the  SNSM  filter  are  subtracted  from  the 
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INS  navigation  solution  to  generate  the  best  possible  navigation  solution  available, 
jc  =  jc  +  [27,33].  Now  that  the  MatSOFE  implementation  of  the  SNSM 

filter  has  been  explained,  the  truth  and  filter  models  for  the  GPS,  DGPS,  and  the  INS 
subsystems  will  be  described. 
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Figure  1 1 1-3.  Truth  and  Filter  Model  Block  Diagram 
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3.6  Space  Navigation  System  Model  (SNSM)  Description 


This  section  presents  the  truth  and  filter  model  propagation  and  measurement 
equations,  (2.38)  and  (2.39),  respectively.  The  following  presentation  will  be  divided  up 
by  navigation  subsystems  with  most  parts  taken  directly  from  [27].  First  the  INS  portion 
of  the  equations  will  be  presented,  then  the  GPS  followed  by  the  DGPS.  Before  the 
different  navigation  subsystems  are  individually  described,  the  high-level  state  and 
measurement  equations  for  the  SNSM  filter  are  provided,  followed  by  those  for  the  truth 
model.  Equations  (3.1)  and  (3.2)  show  how  the  different  navigation  subsystems  models 
combine  to  form  a  single  SNSM  filter  model: 


^INSf  ^  ^INSf 

.  '  =  5x,+  ' 

^  ^  GPS^  ^GPSf 

(3.1) 

^GPSf 

(3.2) 

where  the  process  and  measurement  noises  are  described  as 

(3.3) 

(3.4) 

As  stated  earlier,  the  overall  filter  model  consists  of  13  states:  1 1  for  the  INS  and 
2  for  the  GPS/DGPS.  A  description  of  the  13-state  vector,  dx^ ,  implemented  in  the  filter 

model  can  be  found  in  Table  A-5  in  Appendix  A.  References  to  further  descriptions  of 
the  sub-matrices  in  the  filter  equations  can  be  found  in  Table  III-3.  The  barometric 
altimeter  aiding  measurements  are  considered  to  be  INS  measurements  (represented 
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through  appropriate  elements  in  the  F  matrix  to  denote  continuous  time  updating,  rather 
than  treating  them  as  explicit  measurements  to  be  handled  by  the  Kalman  filter),  while 
the  GPS/DGPS  measurements  are  the  respective  updates  for  the  baro/inertial  system  from 
the  GPS/DGPS. 

Table  1 1 1-3.  References  for  the  Sub-Matrices  of  the  SNSM  Truth  and  Filter 


Filter  Model 

Location  of 
Description 

Truth  Model 

Location  of 
Description 

p 

INSf 

Section  3. 6. 1.3 

p 

Section  3. 6. 1.1, 
3.6.L2 

- 

- 

P 

/V5„ 

Section  3. 6. 1.2 

- 

- 

P 

INSn 

Section  3. 6. 1.2 

P 

^  GPSf 

Section  3.6.2. 1 

P 

^  GPS, 

Section  3.6.2. 1 

P 

DGPSf 

Section  3. 6.2. 2 

P 

^  DGPS, 

Section  3. 6.2. 2 

^INSf 

Section  3. 6. 1.3 

^INS, 

Section  3. 6. 1.1 

^GPSf 

Section  3.6.2. 1 

^GPS, 

Section  3.6.2. 1 

^  DGPSf 

Section  3. 6.2.2 

^DGPS, 

Section  3. 6.2. 2 

TT 

^  INS  f 

Section  3. 6. 1.4 

^ INS, 

Section  3. 4. 1.4 

^GPSf 

Section  3. 6.2.4 

P^GPS, 

Section  3. 6.2. 4 

TT 

^  DGPSf 

Section  3. 6.2. 5 

TT 

“  DGPS, 

Section  3. 4.2. 5 

The  propagation  and  measurement  equations  for  the  SNSM  truth  model  is 
presented  in  similar  fashion  below: 


P 

Filter 

p 

^1NS„ 

0 

^Filter 

0 

P 

^  INS,  2 

0 

dXf  + 

^INS„ 

0 

0 

F 

^GPS„  \ 

^GPS„ 

(3.5) 


(3.6) 
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The  SNSM  truth  model  eonsists  of  the  original  thirteen  states  of  the  filter  model 
(represented  by  ^Filter  and  yv Filter),  augmented  by  additional  INS  and  GPS/DGPS  states. 
The  total  number  navigation  subsystems  state  is  69;  39  INS  states,  and  30  GPS  states  for 
GPS  integrated  systems,  and  61;  39  INS  states,  and  22  DGPS  states  for  DGPS  integrated 
systems.  Table  A-lthrough  Table  A-4,  in  Appendix  A,  provide  a  full  deseription  of  each 
individual  state  of  the  truth  model.  Table  B-1  through  Table  B-6,  and  Table  B-7  through 
Table  B-9  in  Appendix  B  have  a  complete  listing  of  the  components  of  the  F  elements 
and  the  Q  noise  strengths  associated  with  the  w  vector  components  in  Equation  (3.5). 

There  is  one  crucial  difference  between  the  first  thirteen  states  of  the  filter  model 
and  the  first  thirteen  states  of  the  truth  model  [27,33].  The  filter  model  dynamics  driving 
noise  and  measurement  noise  do  not  correlate  exactly  with  those  of  the  first  thirteen  states 
of  the  truth  model.  To  achieve  good  tuning  against  the  truth  model,  the  filter  model  noise 
statistics  values  (Qfand  Rf )  have  been  altered  [27,33].  The  following  sections  will 
provide  a  detailed  presentation  into  the  exact  make-up  of  the  truth  and  filter  model 
propagation  and  measurement  equations  for  all  navigation  subsystems  used  in  this  thesis. 

3.6.1  The  Inertial  Navigation  System  (INS)  Model 

This  section  presents  the  truth  and  filter  models  used  for  the  INS.  The  INS  model 
is  a  strapped-down  wander  azimuth  system  that  senses  aircraft  motion  via  gyros  and 
accelerometers  and  is  used  as  the  primary  source  for  navigation  [27].  The  INS  model  has 
been  derived  from  a  medium  accuracy  ring  laser  gyro  (REG)  INS  93-state  model  [18,33]. 
Eirst,  the  original  93 -state  model  will  be  presented,  followed  by  the  reduced-ordered 
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39-state  truth  and  1 1 -state  filter  models.  After  the  INS  truth  and  filter  state  equations 
have  been  defined,  barometric  altimeter  measurement  equations  will  be  presented. 

3. 6. 1.1  The  93-State  LN-93  Error  Model 

The  93-state  Litton  INS  computer  model  has  been  generated  by  the  Wright 
Laboratories,  Avionics  Directorate,  Avionics  System  Integration  and  Research  Team 
(ASIRT).  Their  development  uses  both  past  AFIT  research  and  INS  vendor  [18] 
documentation  to  “fine-tune”  past  modeling  efforts  [33,36,43].  The  93-state  model 
generates  a  high  number  of  documented  error  sources  that  are  found  in  the  Litton  wander- 
azimuth  LN-93  INS  [18].  These  errors  are  described  using  six  categories  of  states 
[27,33]; 

JXg  j  (3.7) 

where  Sx  is  a  93  x  1  column  vector  and: 

Sx^ ;  represents  the  "general"  error  vector  containing  13  position,  velocity, 
attitude,  and  vertical  channel  errors  (representative  of  a  Pinson  9-state 
model  of  INS  error  characteristics  augmented  with  4  altimeter  error 
states). 

Sx2 :  consists  of  16  gyro,  accelerometer,  and  baro-altimeter  exponentially  time- 
correlated  errors,  and  "trend"  states.  These  states  are  modeled  as  first 
order  Markov  processes  in  the  truth  (system)  model. 
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Sx^ :  represents  gyro  bias  errors.  These  18  states  are  modeled  as  random 
eonstants  in  the  truth  model. 

Sx^ :  is  eomposed  of  the  aeeelerometer  bias  error  states.  These  22  states  are 
modeled  in  exaetly  the  same  manner  as  the  gyro  bias  states. 

Sx^ :  depiets  aeeelerometer  and  gyro  initial  thermal  transients.  The  6  thermal 
transient  states  are  first  order  Markov  proeesses  in  the  system  model. 

Sx^ :  models  the  gyro  eomplianee  errors.  These  18  error  states  are  modeled  as 
biases  in  the  system  model. 

The  93-State  Litton  model  state  spaee  differential  equation  is  given  by: 

Sx^  ^11  ^12  ^13  ^14  ^15  ^16  ^-'"1 

Sx^  0  F22  0  0  0  0  Sx2  W2 

Sxj  0  0  0  0  0  0  0 

Sx^  0  0  0  0  0  0  Sx^  0 

Sx^  0  0  0  0  F55  0  dx^  0 

Sx,  0  0  0  0  0  0  0 

A  full  deseription  of  the  sub-matriees  for  this  equation  is  given  in  the  Litton  LN- 
93  manual  [18].  This  large  state  model  represents  the  most  aeeurate  model  available  for 
the  LN-93  navigation  errors  [27,33]. 

3. 6.1.2  The  39-State  INS  Truth  Model 

The  93 -state  model  is  a  very  aeeurate  representation  of  the  INS  error 
eharaeteristies,  but  the  high  dimensionality  of  the  state  equations  makes  the  model  very 
CPU-intensive  for  “first-look”  projeets.  The  intent  of  this  thesis  is  to  evaluate 
performanee  eharaeteristies  assoeiated  with  a  partieular  class  of  INS  (medium  preeision 


111-20 


or  lower  precision).  Previous  AFIT  theses  have  demonstrated  that  reduced-ordered  truth 
models  can  be  used  in  place  of  the  93-state  truth  model  without  losing  a  significant 
degree  of  accuracy  [27,33].  Therefore  the  INS  truth  model  has  been  reduced  to  a  39-state 
model.  The  reduced-ordered  model  retains  only  the  truly  essential  states  from  Equation 
(3.8).  The  truth  model  state  space  equation  is  defined  in  Equation  (3.9): 


Sx, 

>11 

Fn 

Fn 

Fn 

X 

>i' 

Sxj 

0 

Fn 

0 

0 

< 

Sx2 

H>2 

Sx^ 

0 

0 

0 

0 

Sx^ 

0 

X- 

0 

0 

0 

0 

X 

0 

It  should  be  noted  that  the  INS  truth  state  vector  Jjc  is  a  39-state  vector.  The  four 
components  of  Sx  in  Eq.(3.9)  do  not  directly  correlate  to  the  first  four  components  of 
the  93-state  Eitton  model  [27,33].  Eor  a  complete  listing  of  the  39  states  and  how  they 
relate  to  those  in  [18],  see  Table  A-1  and  Table  A-2  in  Appendix  A 

3. 6. 1.3  The  11  -State  INS  Filter  Model 

The  INS  filter  model  retains  the  essential  states  from  the  39-state  truth  model. 
Through  past  AEIT  research,  the  1 1 -state  INS  filter  has  been  shown  to  perform 
adequately  when  given  frequent  GPS/DGPS  measurement  updates  [6,10,27,33].  The  1 1 
states  are  composed  of  the  standard  9  states  for  the  Pinson  INS  error  model,  and  two 
states  (clock  bias  and  clock  drift)  for  the  GPS  or  DGPS.  Table  A-5  in  Appendix  A  shows 
the  1 1  states  used  for  the  INS  filter  model.  The  final  INS  filter  dynamics  submatrix,  F,  as 
well  as  process  noise  strength  Q  and  measurement  noise  covariance  R,  can  be  found  in 
Appendix  B 
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3.6.2  The  Global  Positioning  System  (GPS)  Model 

The  GPS  navigation  system  used  is  based  on  electromagnetic  signals  transmitted 
from  orbiting  GPS  satellites.  This  model  has  been  developed  throughout  research  at 
AFIT,  and  many  of  its  fundamental  concepts  are  addressed  in  a  variety  of  sources 
[6,10,27,33,36].  GPS  generates  navigation  information  by  acquiring  the  range  to 
multiple  satellites  of  known  position,  called  ''pseudoranges'”.  Inherent  in  the 
pseudorange  are  errors  caused  by  ionospheric  and  tropospheric  delays,  satellite  clock 
biases,  receiver  noise,  and  ephemeris  errors  [25,34].  These  errors  work  together  to  dilute 
the  accuracy  of  standard  GPS  to  a  level  of  a  couple  of  meters,  depending  on  the  range 
resolution  technique  being  used.  By  incorporating  the  differential  corrections  to  the 
standard  GPS  pseudoranges,  one  can  achieve  much  higher  navigation  precision.  Several 
error  sources  can  be  eliminated  or  significantly  reduced  because  these  errors  are  common 
to  both  the  reference  station  receiver  and  the  user’s  receiver.  These  errors  are  composed 
of  the  satellite’s  clock  error,  errors  in  the  satellites’s  broadcasted  ephemeris  data,  and 
signal  propagation  delays  that  are  not  accounted  for  by  the  receiver’s  measurements  or 
modeling.  When  two  receivers  in  the  same  vicinity  (within  about  100  nautical  miles)  are 
using  the  same  set  of  four  satellites,  the  above  errors  will  be  common  to  both  and  can  be 
removed  or  essentially  eliminated  by  differential  techniques  [25,34].  The  navigation 
information  passed  to  the  SNSM  filter  is  the  respective  range  and  ephemeris  data  position 
to  each  of  four  satellites,  with  differential  corrections  applied  to  provide  more  accurate 
information  [33].  The  next  four  sections  present  all  the  necessary  equations  to  define  the 
GPS  and  DGPS  truth,  and  associated  filter  error  models  fully. 
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3. 6.2.1  The  30-State  GPS  Truth  Model 


There  are  five  types  of  error  sourees  that  are  modeled  in  the  GPS  truth  model  state 
equations.  The  first  two  states  represent  the  errors  in  the  user  eloek  and  are  modeled  as 
follows: 


\^clku]_ 

■Q 
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j 

0 

0 

(3.10) 


where 

II 

range  equivalent  of  user  clock  bias 

^^clku 

velocity  equivalent  of  user  clock  drift 

The  initial  state  estimates  and  eovariances  for  these  states  were  ehosen  to  be 


eonsistent  with  previous  AFIT  researeh,  [6,10,27,33,36].  and  are: 
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Beeause  these  error  sources  are  a  function  of  the  user  equipment,  they  are  common  to  all 
the  satellite  vehicles.  The  remaining  five  sources  of  errors  are  unique  to  each  satellite 
vehicle  (SV),  based  on  their  individual  equipment  and  their  position  with  respect  to  the 
user.  The  first  SV-specific  error  source  for  GPS  is  the  code  loop  error,  .  Although 

the  code  loop  is  part  of  the  user  equipment  shared  by  all  the  SV's,  its  error  magnitude  is 
relative  to  each  SV.  The  second  and  third  SV-specific  errors  are  the  atmospheric 
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interference  with  the  EM  signals,  dRion  ,  as  related  to  the  ionospheric  and 

tropospheric  delay,  respectively,  in  the  signal's  propagation.  The  code  loop  error,  the 
tropospheric  delay  and  ionospheric  delay  are  all  modeled  as  first  order  Markov  processes 
with  time  constants  shown  in  Equation  (3.13),  consistent  with  previous  AEIT  research 
[10,27,33,36].  Both  are  driven  by  zero-mean  white  Gaussian  noise  with  strengths  shown 
in  Equation  (3.16).  The  fourth  SV-specific  error  source  is  due  to  inaccuracies  in  the 
clocks  on  board  the  SV's,  SR^^u^ .  By  using  differential  corrections,  this  error  source  was 

also  removed  from  the  DGPS  model.  The  final  error  source  was  based  on  line-of-sight 
errors  between  the  SV's  and  the  receiver,  ,  respectively.  The  model  for 

these  states  is  shown  in  Equation  (3.13): 

-1  0  0  0  0  0  0]  ^^cioop  r  ' 

0  -1/500  0  0  0  0  0  ^^trop 

0  0  -1/1500  0  0  0  0  SR^on 

0  0  0  0  0  0  0  J  SRs,ij,  UJ  0  [  (3.13) 

0  0  0  0  0  0  0  0 

0  0  0  0000  0 
0  0  0  000  0  ^2  0 
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where  the  initial  eovarianee  for  the  states  is  given  by: 


0.25/t^  0  0  0  0  0  0 

0  1.0/t^  0  0  0  0  0 

0  0  1.0/t^  0  0  0  0 

Pgp5(^o)=  0  0  0  25 ft^  0  0  0  (3.14) 

0  0  0  0  25ft^  0  0 

0  0  0  0  0  25ft^  0 

0  0  0  0  0  0  25ft\ 


and  mean  values  and  strengths  of  the  dynamies  driving  noise  are  given  by: 

E{>^GPs(t)]  =  0  (3.15) 


0.5  0  0  0  0  0  0 

0  0.004  0  0  0  0  0 

0  0  0.004  0  0  0  0  2 

e{wgps(0>^gpsO  +  '^)}  =0  0  0  0000  S(t)^  (3.16) 

0  0  0  0  0  0  0 

0  0  0  0  0  0  0 

0  0  0  0  0  0  0 

Equations  (3.13)  -  (3.16)  are  repeated  for  each  of  four  satellites  and  then  this  is  added  to 
Equations  (3.10)  -  (3.12)  to  get  30  states. 

A  quick  reference  of  the  truth  model  non-zero  GPS  dynamics  matrix  components 
is  provided  in  Table  B-5  of  Appendix  B.  This  ends  the  description  of  the  30-state  truth 
model  for  standard  GPS. 
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3. 6.2.2  The  22-State  DGPS  Truth  Model 


Like  the  GPS  truth  model,  there  are  five  types  of  error  sourees  that  are  modeled  in 
the  DGPS  truth  model  state  equations.  The  first  two  states  represent  the  errors  in  the  user 
elock  and  are  identieal  to  the  first  two  states  in  the  previous  seetion.  They  are  modeled  as 
follows: 


\^cikA_ 

■Q 

r 

j 

0 

0 

\^Clky  \ 

(3.17) 


where 

II 

range  equivalent  of  user  clock  bias 

^^clku 

velocity  equivalent  of  user  clock  drift 

The  initial  state  estimates  and  eovarianees  for  these  states  were  ehosen  to  be 


eonsistent  with  previous  AFIT  researehes  [6,27,33,36],  and  are: 


(3.18) 


and 


(^o)  = 


9.0xl0‘V^'  0 

0  9.0x10'“/^' /5ec' 


(3.19) 


Because  these  error  sources  are  a  function  of  the  user  equipment,  they  are 
common  to  all  the  satellite  vehicles.  The  remaining  five  sources  of  errors  are  unique  to 
each  satellite  vehicle  (SV),  based  on  their  individual  equipment  and  their  position  with 
respect  to  the  user.  The  first  SV-specific  error  source  for  GPS  is  the  code  loop  error, 
SRdoop  ■  Although  the  code  loop  is  part  of  the  user  equipment  shared  by  all  the  SV's,  its 
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error  magnitude  is  relative  to  eaeh  SV.  The  work  done  by  Negast  [33]  has  shown  that, 
with  differential  correetions  applied,  this  error  can  be  removed  from  the  DGPS  model. 
The  second  and  third  SV-specific  errors  are  the  atmospheric  interference  with  the  EM 
signals,  and  ,  as  related  to  the  ionospheric  and  tropospheric  delay  in  the 

signal's  propagation.  The  tropospheric  delay  and  ionospheric  delay  are  both  modeled  as 
first  order  Markov  processes  with  time  constants  shown  in  Equation  (3.20),  consistent 
with  previous  AEIT  research  [6,27,33,36].  Both  are  driven  by  zero-mean  white  Gaussian 
noise  with  strengths  shown  in  Equation  (3.23).  The  fourth  SV-specific  error  source  is 
due  to  inaccuracies  in  the  clocks  on  board  the  SV's,  using  differential 

corrections,  this  error  source  was  also  removed  from  the  DGPS  model.  The  final  error 
source  was  based  on  line-of-sight  errors  between  the  SV's  and  the  receiver,  , 


&Si ,  respectively.  The  model  for  these  states  is  shown  in  Equation  (3.20): 

r-Jj  0  0  0  olf'J'i,™,! 

SR,..  0  -,4  0  0  0  SR,„ 

<  [=  0  0  0  0  0  J  \  +  l  0  > 

0  0  0  0  0  0 

[  0  0  0  0  oj  [  0 

where  the  initial  covariance  for  the  states  is  given  by: 

0  0  0  0  " 

0  1.0/t"  0  0  0 

VnGPs(h)=  0  0  0.35  0  0 

0  0  0  0.35  0 

0  0  0  0  0.35ft\ 


(3.20) 


(3.21) 
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and  mean  values  and  strengths  of  the  dynamies  driving  noise  are  given  by: 


(3.22) 


^\^DGPS  ^)} 


0.001 

0 

0 

0 

0 


0  0  0 

0.0004  0  0 

0  0  0 

0  0  0 

0  0  0 


see 


(3.23) 


The  redueed  dynamie  driving  noise  strengths  from  standard  GPS  are  indieative  of 
the  error  reduction  for  these  remaining  states  when  differential  corrections  are  applied.  A 
quick  reference  of  the  truth  model  non-zero  DGPS  dynamics  matrix  components  is 
provided  in  Table  B-6  of  Appendix  B  This  ends  the  description  of  the  22-state  truth 
model  for  DGPS.  Now  the  filter  model  will  be  presented. 


3. 6.2. 3  The  2-State  GPS/DGPS  Filter  Model 


Various  research  efforts  have  shown  that  two  states  provide  a  sufficient  model  for 
GPS  and  DGPS  [6  10,27,33,36,43].  The  primary  argument  is  that  the  errors  modeled  by 
the  other  states  in  the  previous  two  sections  are  small  when  compared  to  the  two  states 
common  to  all  SV's.  By  adding  dynamics  driving  noise,  of  strength  Q,  and  re-tuning  the 
filter,  the  overall  performance  of  the  DLSM  can  be  maintained  with  the  significantly 
reduced-order  model  of  Equation  (3.24): 
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0 


1 

0 


-I- 


Wr 


(3.24) 
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The  values  implemented  for  the  dynamics  driving  noise  strengths  can  be  found  in 
Tables  B-10  through  B-12  of  Appendix  B.  It  should  be  noted  that,  in  the  tuning  process, 
the  measurement  noise  covariance  values  R  (as  shown  in  Appendix  B)  have  also  been 
adjusted  to  achieve  adequate  tuning  of  the  fdter  [20].  This  completes  the  description  of 
the  GPS/DGPS  filter  model.  The  next  section  presents  the  GPS/DGPS  measurement 
equations  for  both  the  truth  and  the  filter  models. 

3, 6.2. 4  GPS  Measurement  Model 


There  are  four  GPS  measurement  updates,  one  for  each  of  the  satellite 
pseudorange  signals  received  by  the  SNSM  filter.  These  measurement  updates  are  once 
again  dijference  measurements.  First  the  DGPS  truth  model  difference  measurement  will 
be  fully  presented,  followed  by  a  brief  description  of  the  filter  measurement  model. 

The  GPS  difference  measurement  is  formed  by  taking  the  difference  of  the  INS- 
calculated  pseudorange,  and  actual  pseudorange,  Rgpg : 


^^GPS  ~  ^INS  ^GPS 


(3.25) 


The  real  pseudorange,  is  the  sum  of  the  true  range  from  the  user  to  the  satellite  plus 
all  the  errors  in  the  pseudorange  signal  propagation.  The  measurement  equation  is 
modeled  as: 


^GPS  ~  +  ^cloop  +  ^trop  +  ^ion  +  ^Sclk  +  ^Uclk  (3  -26) 

where 

^GPS  ^  GPS  pseudorange  measurement,  from  SV  to  user 
Ri  =  true  range,  from  SV  to  user 
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SRcioop  =  range  error  due  to  eode  loop  error 
SR,^op  ^  range  error  due  to  tropospherie  delay 
SRig^  =  range  error  due  to  ionospherie  delay 
SRgcik  =  range  error  due  to  SV  cloek  error 

SRudk  =  range  error  due  to  user  eloek  error 

V  =  zero-mean  white  Gaussian  measurement  noise 

Note  that,  sinee  v  is  assumed  zero-mean,  white  Gaussian  noise,  statistieally 
speaking,  one  ean  ehoose  v  with  either  a  plus  "+"  or  minus  eoeffieent  in  Equation 
(3.26).  The  author  ehooses  the  eoefficient  earefully  so  that  the  end  result  shows  a  plus  "+ 
v"  sign  in  Equation  (3.31)  and  Equation  (3.32). 

The  seeond  souree  of  a  range  measurement  is  the  INS  itself,  Rjj^s  [27,33].  Rjj^s  is 
the  difference  between  the  SNSM-calculated  position,  Xu  and  the  satellite  position  from 
the  ephemeris  data  Xg.  This  difference  vector  is  represented  below  in  the  ECEE  frame 

^INS  ~  \^U  ~  I  ~ 

An  equivalent  form  for  Equation  (3.27))  is 

Rm  =  V(%  - )"  +  (To  -ysf  +  (%  - f  (3 -28) 

Based  on  Assumption  xiv  from  Chapter  1,  Equation  (3.28)  can  be  approximated 
and  rewritten  in  terms  of  the  true  range  and  a  truncated  first-order  Taylor  series,  with 
perturbations  representing  the  errors  in  Xu  and  Xs: 
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(3.27) 
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■5X,^- 


^^INsi^S’^u) 


dX, 


■5X, 


(3.29) 


S,'-UJnom 


The  solution  for  Rj^s  is  found  by  substituting  Equations  (3.28)  into  Equation  (3.29)  and 
evaluating  the  partial  derivatives  to  get  [27,33]. 


Rt- 
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ys-yu 
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Rjns 
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(3.30) 
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Einally,  the  GPS  pseudorange  truth  model  difference  measurement  is  given  as: 

^^GPSt  ~  ^INS  ~  ^GPS 
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(3.31) 


The  user  position  errors  in  Equation  (3.31)  ean  be  derived  from  the  first  three  states  of  the 
filter  or  truth  model  using  an  orthogonal  transformation  [27,33]. 

The  filter  design  model  for  the  GPS  measurement  will  now  be  derived.  Since 
the  filter  model  does  not  contain  the  states  for  the  errors  in  the  satellite  position,  these 
terms  are  removed  from  the  equation.  The  filter  model  measurement  equation  can 
therefore  be  written  as: 
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(3.32) 
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The  filter  measurement  noise  variance,  R,  will  be  tuned  to  attain  adequate 
performance  despite  the  reduction  in  order  from  the  truth  model  and  despite  the 
approximation  of  the  truncated  Taylor  series.  The  measurement  noise  variances  for  both 
the  filter  and  the  truth  model  equations  are  provided  in  Table  B-13  of  Appendix  B.  This 
completes  the  description  of  the  GPS  measurement  equations  and  the  entire  SNSM  filter 
and  truth  model  equations  for  a  standard  GPS-aided  INS. 


3. 6.2. 5  DGPS  Measurement  Model 


There  are  four  differentially  corrected  GPS  measurement  updates,  one  for  each  of 
the  satellite  range  signals  received  by  the  SNSM  filter.  These  measurement  updates  are 
once  again  difference  measurements.  First  the  DGPS  truth  model  difference 
measurement  will  be  fully  presented,  followed  by  a  brief  description  of  the  filter 
measurement.  The  DGPS  difference  measurement  is  formed  by  taking  the  difference  of 
the  INS -calculated  pseudorange,  Rjj^^  and  actual  pseudorange,  R^qps  . 


■  ^INS  ^DGPS 


(3.33) 


The  real  pseudorange,  Rp,Qps  is  the  sum  of  the  true  range  from  the  user  to  the 


satellite  plus  all  the  errors  in  the  pseudorange  signal  propagation.  After  differential 
corrections  are  applied,  the  measurement  equation  is  modeled  as: 

^DGPS  =^l+  ^nop  +  ^ion  +  ^Uclk  “  ^  (3.34) 
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where 


Rdgps  ^  Differentially  eorrected  GPS  pseudorange  measurement,  from  SV  to 
user 

Rf  =  true  range,  from  SV  to  user 
SR^.op  ^  range  error  due  to  tropospherie  delay 
SRig^  =  range  error  due  to  ionospherie  delay 

SRudk  =  range  error  due  to  user  eloek  error 
V  =  zero-mean  white  Gaussian  measurement  noise 
A  development  analogous  to  equations  (3.27)  through  (3.30)  ean  be  aeeomplished,  and 
finally,  the  DGPS  pseudorange  truth  model  dijference  measurement  is  given  as: 

^^DGPS,  ~  ^INS  ~  ^DGPS 


As  before,  the  user  position  errors  in  Equation  (3.35)  ean  be  derived  from  the  first 
three  states  of  the  filter  or  truth  model  using  an  orthogonal  transformation  [27,33]. 

The  filter  design  model  for  the  DGPS  measurement  will  now  be  derived.  Sinee 
the  filter  model  does  not  eontain  the  states  for  the  errors  in  the  satellite  position,  these 
terms  are  removed  from  the  equation.  The  filter  model  measurement  equation  can 
therefore  be  written  as: 
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The  filter  measurement  noise  varianee,  R,  will  be  tuned  to  attain  adequate 
performance  despite  the  reduction  in  order  from  the  truth  model  and  despite  the 
approximation  of  the  truncated  Taylor  series.  The  measurement  noise  variances  for  both 
the  filter  and  the  truth  model  equations  are  provided  in  Table  B-13  of  Appendix  B.  This 
completes  the  description  of  the  DGPS  measurement  equations  and  the  entire  SNSM 
filter  and  truth  model  equations. 


3. 7  Chapter  Summary 

This  chapter  presents  the  set-up  of  the  SNSM  MatSOFE  computer  simulation. 

An  introduction  to  MatSOFE,  the  WSEM  software,  and  PROFGEN  is  provided.  The 
truth  model  and  filter  model  propagation  and  measurement  equations  are  described  for 
the  INS/Baro,  GPS,  and  DGPS  subsystems.  The  INS/Baro,  GPS,  and  DGPS  truth  model 
is  located  in  tabular  form  in  Appendix  A.  The  dynamic  submatrices  ^Filter  ^iNSti’  ^iNSti’ 
^ GPS  ’  ^ DGPS  ’  process  noise  strength  and  measurement  noise  covariance  matrices  for 

filter  and  truth  models  are  presented  in  Appendix  B  Results  and  analysis  of  the  SNSM 
simulation  are  presented  in  Chapter  4. 
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IV,  Results  and  Analysis 


This  chapter  presents  results  and  analysis  of  the  following  items: 

•  Validation  of  MatSOFE  (comparison  of  MatSOFE  results  to  previous  AEIT 
researehers’  [6,10,27,33]  results  for  the  same  navigation  problem). 

•  “Rocket”  trajeetory  (detailed  Atlas  HAS  flight  profile)  ereated  using 
PROEGEN  [29], 

•  GPS  satellite  ephemeris  data  proeessing  procedures  (GDOP,  PDOP,  HDOP, 
number  of  satellites,  ete.)  using  WSEM  3.6  software  [2]. 

•  Development  and  simulation  of  three  IMS’s  in  MatSOFE. 

•  Filter  tuning  proeess  and  a  tuning  example. 

•  Performanee  results  and  analysis  of  the  GPS/DGPS-aided  INS  system 
integrations  involved  in  this  research.  Table  IV- 1  shows  these  system 
integration  eomparisons. 

•  Chapter  summary 


Table  IV-1.  Case  l-VI  Integration  Comparison 


Case  I 

Case  II 

Case  III 

Case  IV 

Case  V 

Case  VI 

0.4  nm/hr 
CEP  INS 

0.4  nm/hr 
CEP  INS 

2.0  nm/hr 
CEP  INS 

2.0  nm/hr 
CEP  INS 

4.0  nm/hr 
CEP  INS 

4.0  nm/hr 
CEP  INS 

Single-Freq 

Standard 

GPS 

Dual-Freq 

P-code 

DGPS 

Single-Freq 

Standard 

GPS 

Dual-Freq 

P-code 

DGPS 

Single-Freq 

Standard 

GPS 

Dual-Freq 

P-code 

DGPS 

Barometric 

Altimeter 

Barometric 

Altimeter 

Barometric 

Altimeter 

Barometric 

Altimeter 

Barometric 

Altimeter 

Barometric 

Altimeter 

4.1  Validation  ofMATSOFE 

This  research  is  a  follow-on  effort  of  Gray  [10]  and  Britton  [11],  There  are  some 
similarities  along  with  variations  between  their  studies  and  this  study.  They  both  studied 
a  GPS/DGPS-aided  LN-93  INS  [18]  integrated  systems  for  precision  landing  approaches. 
It  has  seen  that  the  truth  models  and  filter  design  error  models  they  used  for  INS  and  GPS 
have  been  utilized  in  AFIT  for  more  than  8  years  as  validated  models,  and  consequently 
they  are  used  as  validated  and  reliable  references  in  terms  of  truth  and  filter  model  for 
both  INS  and  GPS/DGPS  including  truth/filter  measurements  models  in  this  research.  On 
the  contrary,  this  research  dealt  with  evaluating  position  accuracy  for  a  launch  vehicle 
rather  than  accurate  GPS/INS  integrations  for  a  precision  landing  or  airborne  navigation 
application. 

To  accomplish  the  performance  analysis  of  a  GPS-aided  INS  system,  one  has  to 
make  Monte  Carlo  simulations  and/or  covariance  analyses.  As  an  international  officer, 
the  author  was  not  eligible  to  make  use  of  the  MSOFE  software  [30].  MSOFE  is 
restricted  to  use  by  U.S.  government  agencies  and  their  U.S.  contractors.  At  the 
beginning  it  was  not  a  considerable  concern,  but  as  time  passed,  generating  and 
validating  a  performance  evaluation  tool  became  the  biggest  issue  of  this  study.  That  is 
because,  up  to  now,  AEIT  students  have  been  accustomed  to  utilize  MSOEE  [30]  as  a 
performance  evaluation  tool.  Eor  that  reason,  first  of  all,  the  modified  MatSOEE  needs  to 
be  validated  as  a  reliable  performance  evaluation  tool.  The  most  effective  way  of 
validating  MatSOEE  was  to  take  previous  researchers’  data  as  an  input  to  MatSOEE.  If  it 
gives  comparable  outputs  to  the  same  inputs,  then  it  would  be  validated. 
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To  start,  the  original  MatSOFE  was  revised  to  handle  more  eomplieated 
navigation  system  problems,  like  INS/GPS/BARO  integrated  navigation  system  with 
higher-state  and  realistic  truth  model  definitions,  rather  than  an  INS  only  navigation 
system  designed  for  a  simple  specific  problem  with  short  flight  durations.  It  especially 
was  not  convenient  for  this  study  in  terms  of  truth  and  filter  model  state  dimensions, 
“Pinson  error  model”  definition,  and  the  GPS  data  used.  For  more  information  about 
MatSOFE  and  revisions  made  to  MatSOFE,  see  Chapter  3.2,  Introduction  to  MatSOFE. 

The  next  step  was  generating  necessary  simulated  INS  and  GPS  ephemeris  data 
(Sections  4.2  and  4.3  discuss  the  INS  and  GPS  data  simulation  process  in  detail).  For  that 
reason,  the  exact  tanker  aircraft  profile,  FLY  OUT  file  (FFY  OUT  is  the  output  file  of 
the  PFOFGEN)  is  regenerated  by  using  the  provided  PROF  IN  file  (PROF_IN  is  the 
input  file  for  profile  generator,  PROFGEN  [29])  in  Gray’s  thesis  [10].  This  regenerated 
tanker  aircraft  flight  profile  has  been  used  throughout  the  MatSOFE  validation  process. 
The  first  MatSOFE  simulation  run  is  accomplished  by  using  all  Gray’s  [10]  inputs,  same 
FFY  OUT  file  for  tanker  aircraft  and  the  same  day  of  simulated  “true”  GPS  ephemeris 
data.  A  similar  approach  is  tracked  for  Britton  [6]  inputs,  concerning  the  cases  with 
DGPS  integration,  by  using  the  same  simulation  model  except  for  implementing  DGPS 
into  system  rather  than  standard  GPS.  Then  the  validation  scope  is  extended  utilizing 
Mosle’s  [27]  andNegast’s  [33]  inputs  as  well.  The  next  and  succeeding  sections  will 
discuss  comparison  between  original  outputs  they  have  presented  in  their  theses  by 
utilizing  MSOFE  as  an  evaluation  tool,  and  MatSOFE  generated  outputs  for  the  same  set 
of  circumstances.  By  saying  “the  same  set  of  circumstances”,  the  author  means  utilizing 
the  same  F,  Q,  H,  and  R  values  as  used  by  those  previous  researchers  for  both  filter  and 
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the  truth  model.  As  mentioned  earlier,  the  same  error  models  for  LN-93  inertial 
navigation  system,  PROFGEN  output  (FLY  OUT  file),  and  simulated  GPS  data  are  also 
generated  for  eomparison  oases. 

4.1.1  Comparison  to  Gray ’s  Results  [1 0] 

A  GPS -integrated  navigation  system,  using  a  0.4  nm/hr  CEP  INS  with  baro- 
altimeter  inoorporated,  was  a  oommon  study  ease  to  almost  all  previous  AFIT  researohers 
being  traoked  [6,10,27,33].  Gray’s  first  researoh  ease  and  this  researoh’s  first  ease  are 
exaotly  the  “same”  study  oases,  exoept  for  the  flight  profile  (PROFGEN  data)  used. 
Aotually,  creating  a  simulation  case  close  enough  to  his  case  depends  on  the  information 
he  declared  in  his  thesis.  During  the  comparison  phase,  some  additional  information  was 
needed  to  duplicate  their  work  to  reflect  the  same  characteristics,  like  USOFE  code 
(USOFE  is  the  user-controlled  portion  of  MSOFE),  filter  and  truth  model  initial  state  and 
covariance  values,  etc.  It  is  almost  impossible  to  reproduce  the  identical  or  exactly  same 
simulation  conditions  for  validation  purposes,  but  the  author  has  confidence  that  the 
reproduced  models  represent  their  work  effectively. 

Figure  G-1  and  Figure  G-2  in  Appendix  G  show  the  MatSOFE-generated  and 
MSOFE-generated  outputs  for  the  same  simulation  case,  respectively.  Only  position  error 
plots  are  shown  in  Appendix  G.  For  more  detailed  comparison,  see  Gray’s  thesis  [10]. 
Under  the  same  simulation  conditions,  MatSOFE  consistently  generates  positions  errors 
that  are  almost  twice  as  accurate  as  the  MSOFE  results.  The  encouraging  thing  about  this 
result  is  that  it  is  not  close  enough  to  say  “same”  in  terms  of  position  accuracy,  but  at 
least  it  is  not  worse.  This  phenomenon  has  also  seen  in  comparison  to  Mosle’s  [27] 
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work.  The  first  approach  to  solve  that  problem  was  to  regenerate  the  simulated  GPS 
ephemeris  data  because  this  result  has  not  been  seen  in  comparison  to  Britton’s  results 
(Britton  did  the  same  study  as  Gray  except  for  using  DGPS  instead  of  GPS). 
Regenerating  GPS  data  didn’t  solve  the  problem.  There  are  two  reasonable  explanations 
for  what  might  cause  that  difference  between  MatSOFE  results,  and  that  of  Gray’s  and 
Mosle’s  cases.  Mosle  implemented  the  USOFE  subroutines  “  ORBIT”  and  “CAECDOP” 
for  GPS  data  simulation  rather  than  simulate  true  GPS  ephemeris  data  in  his  research.  It 
is  believed  that  might  cause  that  disagreement  in  comparison.  In  contrast,  Gray  was  the 
first  researcher  in  AFIT  to  put  the  simulated  true  GPS  ephemeris  data  into  practice,  but 
there  are  inconsistencies  found  between  what  he  stated  in  his  thesis  and  what  was  written 
in  his  USOFE  code  (e.g.,  some  of  his  thesis  filter  process  noise  (Qf)  values  don’t  agree 
either  with  his  USOFE  code  values  or  with  Britton’s  values.)  That  might  be  the 
explanation  for  the  disagreement  in  comparison  with  Gray’s  study.  Insufficient 
conversion  from  MSOFE  into  MatSOFE  could  also  be  accepted  as  another  reasonable 
explanation  to  the  disagreement  experienced,  because,  as  mentioned  before,  reproducing 
someone  else’s  study  environment  is  highly  dependent  on  the  information  gathered, 
related  to  this  study.  The  author  has  never  been  able  to  look  at  the  original  MSOFE  code, 
with  the  result  that  he  could  not  ensure  the  removal  of  any  discrepancies  between  it  and 
the  MatSOFE  implementation.  MatSOFE  outputs  for  the  same  case  as  Mosle’s  [27] 
values  are  presented  later  in  Figure  G-5  of  Appendix  G. 
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4.1.2  Comparison  to  Britton ’s  Results  [6] 

The  inconsistency  faced  in  the  GPS-related  comparison  to  Gray  has  not  been 
experienced  with  Britton’s  DGPS-aiding  0.4  nm/hr  CEP  INS  case  with  internal  baro- 
altimeter  aiding.  As  a  matter  of  fact,  Britton  had  the  same  study  case  just  like  others 
(Gray,  Mosle,  and  Negast)  except  for  P-code  dual  frequency  DGPS  aiding  the  INS  rather 
standard  GPS.  The  MatSOFE-generated  results  for  the  DGPS-aided  INS  integrated 
navigation  system  evaluation  are  close  enough  to  be  declared  as  accurate  as  the  MSOFE- 
generated  one  (see  Figure  G-3  and  Figure  G-4).  This  accuracy  agreement  with  Britton 
study  was  convincing  enough  to  believe  that  MatSOFE  is  a  reliable  performance 
evaluation  tool  for  navigation  system  problems.  For  now,  pronouncing  that  MatSOFE  is 
an  evaluation  tool  as  powerful  as  MSOFE  would  be  an  extremely  optimistic  conclusion. 
But,  Matlab-based  MatSOFE  can  be  upgraded  to  the  same  or  even  higher  level  as 
MSOFE  in  the  future,  because  Matlab  is  quite  a  powerful  programming  language  to 
handle  difficult  computations. 

One  common  thing  faced  in  all  the  comparison  cases  was  that  the  previous 
researchers  preferred  slightly  conservative  tuning  for  their  performance  evaluations. 
Mosle  [27]  explains  the  reason  for  this  choice  in  his  thesis  as:  “  The  conservative  nature 
of  this  tuning  proved  to  be  necessary  to  maintain  good  tracking  of  the  most  important 
navigation  states.”  This  choice  of  tuning  may  be  necessary  for  a  precise  and  intensive 
navigation  problem,  like  the  precision  landing  system,  but  fine  (non-conservative)  tuning 
is  preferred  for  the  rocket  navigation  problem  studied  in  this  research. 
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4.2  The  Launch  Vehicle  (Atlas  HAS)  Flight  Profile 

It  was  a  requirement  to  regenerate  the  “Tanker”  aireraft  profile  for  validation  of 
MatSOFE  to  duplieate  the  previous  studies  in  MatSOFE.  Therefore,  a  PROF  IN 
(PROF_IN  is  the  input  file  for  profile  generator  software,  PROFGEN  [29])  is  ereated  first 
based  on  the  inputs  that  Gray  [10]  provided  in  his  thesis  (the  aetual  PROF  IN  file  used  to 
generate  Tanker  profile  ean  be  found  in  Gray’s  thesis  in  Appendix  C  of  Gray’s  thesis.) 

Although  a  lot  of  insights  into  PROFGEN  were  gained  in  the  Tanker  aireraft 
profile  generation,  a  personal  interview  was  eondueted  with  Dr.  Tragesser  [39]  of  the 
AFIT  Department  of  Aeronauties  and  Astronauties  and  a  sample  roeket  (Delta  II) 
PROF_IN  file  was  requested  from  Dr.  Stanton  Musiek  [31]  of  the  Air  Foree  Researeh 
Faboratory  prior  to  generating  the  launeh  vehiele  profile.  PROFGEN  reads  in  the 
PROF  IN  file,  and  outputs  a  binary  flight  profile  output  variables  file  (user-seleeted 
variables,  see  Table  III-l)  ealled  “FFY  OUT.ase”. 

As  diseussed  earlier,  the  launeh  vehiele  is  simulated  by  assuming  it  to  be  launehed 
from  Cape  Canaveral  AS,  SFC-41,  with  the  following  initial  eonditions: 

•  Initial  latitude  28.5°  A 

•  Initial  longitude  8 1.0°  IF 

•  Initial  altitude  0  feet 

•  Initial  ground  path  heading  90.0° 

All  initial  eonditions,  flight  segments  and  durations,  and  user-seleeted  input  and 
output  variables  and  their  units,  ete.  are  all  presented  in  Appendix  C.  Also,  Table  IV-2 
shows  the  aetual  launeh  operation  sequenee  of  the  Atlas  HAS.  With  the  assumption  of 
exeeuting  launeh  operations  from  Cape  Canaveral  AS,  two  available  orbit  inelination 
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options  allow  the  choice  of  any  inclination  between  28.5°  -55.0°  or  90.0° .  The  90.0° 
inclination  orbit  is  usually  preferred  for  the  missions  which  require  watching  every  part 
of  the  Earth  39].  The  author  picked  28.5°  inclination  orbit  as  a  fair  choice  for  a  satellite 
launch  into  low  earth  orbit  (LEO). 


Table  IV-2.  Atlas  HAS  Launch  Operation  Sequence  [15] 


EVENT 

Time  (sec) 

Liftoff 

0.0 

Ground-Lit  SRB  Burnout 

54.7 

Air-Lit  SRB  Ignition 

60.0 

Ground-Lit  SRB  Jettison 

77.1 

Air-Lit  SRB  Burnout 

115.3 

Air-Lit  SRB  Jettison 

117.2 

Atlas  Booster  Engine  Cutoff 

163.3 

Booster  Package  Jettison 

166.4 

Payload  Pairing  Jettison 

214.5 

Atlas  Sustainer  Engine  Cutoff 

289.2 

Atlas/Centaur  Separation 

293.3 

Centaur  Main  Engine  Start  (MESl) 

309.8 

Centaur  Main  Engine  Cutoff  (MECOl) 

584.8 

Start  Turn  To  Main  Engine  Start  2  (MES2) 

1180.8 

Centaur  Main  Engine  Start  (MES2) 

1475.8 

Centaur  Main  Engine  Cutoff  (MEC02) 

1571.9 

Start  Alignment  To  Separation 

1573.9 

Begin  Spinup 

1691.9 

Separate  Spacecraft 

1798.9 

Start  Turn  To  Collision&  Contamination 
Avoidance  Maneuver  (CCAM) 

1918.9 

Centaur  End  Of  Mission 

4239.9 

Note:  SRB  stands  for  Solid  Rocket  Booster. 
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4.3  Development  of  the  Three  Types  of  INS’s 

The  three  grades  of  INS  (0.4,  2.0,  and  4.0  nm/hr  CEP  INS)  are  assumed  to  be 
good  representative  of  military  grade,  eommereial  grade,  and  less  expensive  (possible 
MEMS  in  a  few  years)  Inertial  Navigation  Systems.  Eor  navigation  problems  like  roeket 
launeh,  it  is  believed  and  assumed  that  INS  and  GPS  sensors  will  always  be  redundant. 
Prom  this  assumption,  and  taking  the  ehosen  orbit  (EEO)  into  aeeount,  there  comes 
another  assumption:  no  GPS  outages.  Now  it  can  be  clearly  said  that  the  GPS  will  be  the 
dominant  system,  and  overall  position  accuracy  will  be  dictated  by  GPS  accuracy 
performance.  Despite  the  facts  mentioned  above,  the  three  grades  of  INS  are  included  in 
the  research  scope.  It  is  believed  that  the  results  obtained  in  each  of  the  cases  will  be  a 
useful  reference  for  ongoing  research  and  development  efforts. 

Gray  [10]  says  that  he  developed  good  models  for  the  three  grades  of  INS  with 
the  modifications  he  made  to  the  initial  system  covariance  matrix  by  only  altering  the 
random  constant  shaping  filter  states  (and  not  changing  the  1st  order  Gauss-Markov  drift 
states,  etc.).  Unfortunately,  inconsistencies  are  found  between  what  he  stated  in  his  thesis 
and  what  was  found  in  his  USOPE  code  (user-controlled  ,  problem-specific  portion  of 
MSOPE  code  for  simulation).  He  says  that  he  altered  the  initial  covariance  conditions  of 
the  system,  but  they  are  all  zeroed  out  in  his  USOPE  code.  When  what  he  said  in  his 
thesis  is  exactly  applied  in  MatSOPE,  the  filter  estimation  goes  unstable  after  aboutlOO 
sec  of  flight.  Then,  after  personal  discussions  with  Dr.  Maybeck  (thesis  advisor)  and  Dr. 
Musick  [31],  it  was  decided  that  system  process  noise  values  (Qs)  should  be  altered  rather 
than  initial  covariance  to  simulate  these  different  grades  of  INS’s.  In  this  thesis,  this 
method  is  applied.  The  truth  and  filter  process  noise  values  are  shown  in  Appendix  B. 
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4.4  Filter  Tuning  Process 

The  reduced  order  truth  model  (69  states  for  GPS-aided  INS  and  61  for  DGPS- 
aided  INS)  requires  a  large  amount  of  computer  processing  .  One  of  the  objectives  in  this 
thesis  is  to  minimize  the  computer  processor  time  (especially  taking  into  account  the  fact 
that  Matlab  [37]  is  not  a  compiled  language)  and  memory  cost.  For  that  reason,  the  13- 
state  filter  model  is  chosen  as  the  truth  model  subset  (usually  called  the  filter  design 
model,  and  it  should  satisfactorily  model  the  truth  model).  Remembering  that  the  truth 
model  represents  the  real  world,  the  filter  designer’s  goal  is  to  make  sure  that  the  filter 
design  model  represents  the  truth  model  well  (this  process  is  called  tuning).  One  of  the 
tools  in  filter  designer’s  hand  is  the  dynamics  noise  strength  of  the  white  noises  added  to 
differential  equations  (see  Eq.  (3.5)).  These  are  usually  called  “Q”  values  of  the  filter  or 
briefly  “Qf”.  Another  tool  called  in  order  to  tune  the  filter  is  called  measurement  noises 
parameter  “R”.  It  is  actually  the  covariance  value  of  the  measurement  noise  vector  “v”,  in 
measurement  equations  (see  Eq.(3.6)).  In  this  example  only  “Q”  tuning  will  be  discussed 
because  “R  tuning  follows  a  similar  procedure. 

Consider  the  position,  velocity  and  tilt  error  states  of  Case  II  (0.4  nm/hr 
INS/DGPS/Baro-Altimeter)  that  were  tuned  using  the  legend  in  Eigure  IV-1. 

Hot  legend: 

-  sanple  mean  error 

.  tme  error  (sanple  mean  error  ±<J^) 

-  filter-predicted  error  (0±<T 

Figure  IV-1.  Plot  Legend 
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In  this  thesis  the  tuning  strategy  followed  was:  tuning  the  three  tilt  error  states 


first,  then  veloeity,  and  finally  the  other  states.  When  you  look  at  Figure  H-5  in 
Appendix  H,  you  will  see  non-conservatively  tuned  tilt  errors  compared  to  Figure  H-6  in 
Appendix  H  (the  true  error  and  the  mean  error  ±<7,^^ ,  are  well  within  the  filter  computed, 

0  '^<7 filter  ’  error).  Figure  H-5  has  been  tuned  by  decreasing  Q  value  as  shown  in  Table 
IV-3. 


Table  IV-3.  Q  Values  for  Tilt  Errors  (before  and  after  fine  tuning) 


SMSM 

State  Number 

SNSM 

State  Name 

Q -value 

Before 

Q-value 

After 

4 

East-Tilt 

5.712e-13 

1.428e-13 

5 

North-Tilt 

4.760e-13 

1.900e-13 

6 

Vert(Up)-Tilt 

8.568e-13 

0.952e-13 

Figures  H-1  and  H-2,  and  Figures  H-3  and  H-4  show  the  conservative  and  non¬ 
conservative  tuning  examples  for  position  and  velocity  errors,  respectively.  Also  the 
“before”  and  “after  fine  tuning:”  Q  values  for  position  and  velocity  are  shown  in  Table 
IV-4  and.  Table  IV-5,  respectively. 

Table  IV-4.  Q  Values  for  Velocity  Errors  (before  and  after  fine  tuning) 


SMSM 

SNSM 

Q-value 

Q-value 

State  Number 

State  Name 

Before 

After 

7 

East-velocity 

9.262e-8 

1.021e-8 

8 

North-  velocity 

2.573e-8 

0.253e-8 

9 

Vert(Up)-  velocity 

3.607e-3 

5.152e-5 

IV- 11 


Table  IV-5.  Q  Values  for  Position  Errors  (before  and  after  fine  tuning) 


SMSM 

SNSM 

Q -value 

Q-value 

State  Number 

State  Name 

Before 

After 

1 

Latitude 

7.520e-16 

0.750e-16 

2 

Longitude 

7.092e-16 

0.704e-16 

3 

Altitude 

0 

0 

4.5  Performance  Analysis 

This  section  discusses  the  results  for  Cases  I  -  VI  for  the  satellite  launch  profile. 
The  plots  for  these  cases  are  located  in  Appendix  I  through  Appendix  N. 

4.5.1  Baro-Altimeter  and  Standard  GPS  Aiding  Cases 

As  discussed  before,  the  baro-altimeter  aids  the  INS  up  to  a  flight  altitude  of 
80,000  feet,  whereas  GPS  measurements  are  always  available  for  updating  the  inertial 
system.  The  rocket  flight  profile  was  utilized  to  provide  real  world  information  for  the 
simulation  cases.  As  explained  before,  it  was  assumed  that  there  were  no  satellite  vehicle 
(SV)  outages  for  the  entire  flight  of  the  rocket  profile.  Several  investigations  were 
conducted  by  using  WSEM  software  determine  whether  any  GPS  outage  would  be 
experienced  in  any  phase  of  the  flight  profile  or  not.  The  answer  was  definitely  not. 

4.5.1. 1  Case  I,  0.4  nm/hr  CEP INS/Baro-Alt./ Std.GPS 

A  main  concern  related  to  this  research  was  vertical  channel  instability.  While  the 
GPS  sensor  onboard  the  rocket  is  the  redundant  and  the  dominant  navigation  sensor,  the 
obtained  positioning  results  were  more  accurate  than  needed.  For  instance,  while  the 
desired  vertical  position  accuracy  was  at  the  level  of  50-80  meters,  the  average  vertical 
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position  error  achieved  from  the  GPS-aided  INS  (mean  error  ±<7,^^  )  for  Case  I  was  less 


thanlO  feet.  Table  IV-6  shows  the  lo  Latitude,  Longitude  and  Altitude  Errors  for  Case  1. 


Table  IV-6.  Case  I  1o  Latitude,  Longitude  and  Altitude  Errors 


SMSM 

Error 

State 

Number 

Position  Error 
State 

Case  I 

Mean  True  Error 
(feet) 

Case  I 

True  Error 

(feet) 

Case  I 

Filter  0  ±1(7^^;^^^  Error 
(feet) 

1 

51atitude 

0.48 

2.46 

2.84 

2 

51ongitude 

0.84 

2.45 

2.92 

3 

daltitude 

0.25 

4.45 

6.86 

Upon  careful  inspection  of  Figure  1-2,  which  shows  baro-altimeter  error,  it  will  be 
noticed  that  somehow  the  filter  is  being  told  that  real  world  errors  would  grow  (the  filter 
over-estimates  the  actual  error)  and  it  increases  the  filter-predicted  lo  boundaries  up  to 
almost  550  sec  of  flight.  At  that  point  of  time  filter-predicted  lo  value  converges  to 
normal  values  (begins  to  match  with  true  lo  value).  As  a  matter  of  fact,  there  is  nothing 
wrong  with  the  actual  real-world  error  at  any  time  in  the  entire  profile.  The  first 
diagnostic  attempt  to  solve  that  problem  was  to  investigate  the  vehicle  dynamics  to  see 
whether  anything  was  wrong  with  the  rocket  flight  profile  output  (FLY_OUT)  file  or  not. 
The  same  phenomenon  happened  for  both  tanker  and  rocket  profiles.  It  even  happened  in 
the  artificial  scenario  of  a  flight  profile  simulating  an  aircraft  flying  wings-level  and 
straight  ahead  for  1  hour.  The  second  attempt  entailed  investigating  the  GPS  data.  More 
than  6  different  true  GPS  ephemeris  data  are  simulated  for  random  day  selections.  That 
approach  was  not  a  solution  either.  The  encouraging  aspect  is  that  the  real  world  errors 
and  other  states  of  the  filter  were  not  impacted  appreciably  by  this  erroneous  lo  value 
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and  best  of  all,  they  are  not  being  affeeted  by  the  wrong  prediction  by  the  filter  of  this 
state.  Finally,  after  it  is  carefully  discussed  with  Dr.  Maybeck  (thesis  advisor)  and  Dr. 
Musick,  it  was  left  as  is,  with  little  anticipated  impact  on  the  performance  analysis. 

The  plots  related  to  each  error  state  of  Case  I  are  shown  in  Appendix  I.  They 
amplify  the  trends  already  seen  in  Table  IV-6. 

4. 5.1.2  Case  III,  2. 0  nm/hr  CEP  INS/ Baro-Alt/ Std.  GPS 

Case  III  simulates  the  same  scenario  with  Case  I  except  for  the  2.0  nm/hr  CEP 

INS  replacing  the  0.4nm/hr  CEP  one.  The  same  wrong  filter-predicted  lo  problem  was 
experienced  in  Case  III  also,  and  will  be  experienced  in  Case  V  as  well.  Actually,  that  has 
been  seen  in  all  the  GPS-aided  (vs.  DGPS-aided)  INS  simulation  cases  which  have  been 
carried  out  in  this  research.  Because  of  the  reasons  mentioned  earlier,  GPS  is  the 
dominant  navigation  sensor  of  the  integration,  and  overall  position  accuracy  is  essentially 
determined  by  GPS.  So,  as  expected  in  terms  of  positioning.  Case  I  and  Case  III  provide 
fundamentally  the  same  performance.  But  if  you  look  at  the  tilt  and  velocity  error  states, 
it  is  obvious  that  the  0.4  nm/hr  CEP  INS  has  smaller  errors  when  compared  to  the  2.0 
nm/hr  CEP  INS.  Appendix  K  shows  the  plots  related  to  each  error  state  of  Case  III.  Also 
Table  IV-7  shows  the  lo  Eatitude,  Eongitude  and  Altitude  Errors  for  Case  III. 


Table  IV-7.  Case  III  1a  Latitude,  Longitude  and  Altitude  Errors 


SMSM 

Error 

State 

Number 

Position  Error 
State 

Case  III 

Mean  True  Error 
(feet) 

Case  III 

TrueCTj^yg  Error 
(feet) 

Case  III 

Filter  0  Tlcr^^g,.  Error 
(feet) 

1 

51atitude 

0.54 

2.37 

3.28 

2 

51ongitude 

0.71 

2.43 

3.56 

3 

daltitude 

0.18 

4.48 

6.97 
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4.5.L3  Case  V,  4.0  nm/hr  CEP  INS/ Baro-Alt/ Std.GPS 


The  same  eonsideration  diseussed  for  Case  III  applies  for  Case  V  too.  The 
difference  between  Case  V  from  other  two  GPS-aiding  INS  cases  is  that  Case  V 
simulates  the  4.0  nm/hr  CEP  INS  in  the  integrated  system. 

Appendix  M.  shows  the  plots  related  to  each  error  state  of  Case  V.  Also,  Table 
IV-8  shows  the  lo  Latitude,  Longitude  and  Altitude  Errors  for  Case  V. 


Table  IV-8.  Case  Via  Latitude,  Longitude  and  Altitude  Errors 


SMSM 

Error 

State 

Number 

Position  Error 
State 

Case  V 

Mean  True  Error 
(feet) 

Case  V 

TrueCTj^yg  Error 
(feet) 

Case  V 

Filter  0  Error 

(feet) 

1 

51atitude 

0.25 

2.83 

3.76 

2 

51ongitude 

0.10 

2.94 

4.09 

3 

daltitude 

0.19 

4.91 

6.99 

4.5.2  Baro-Altimeter  and P-Code  DGPS  Aiding  Cases 

The  DGPS-aided  INS  cases  are,  as  expected,  more  accurate  than  GPS-aided  INS 
cases.  They  are  not  only  more  accurate  but  also  more  consistent  with  previous  ALIT 
researcher  Britton’s  [6]  research  results  than  the  GPS-aided  INS  results  were  with  Gray’s 
[10]  work.  The  baro-altimeter  is  assumed  to  be  functioning  until  80,000  feet  and  DGPS 
measurements  are  always  available  for  updating  the  INS.  One  more  nice  point  about 
DGPS  cases  is  that  we  don’t  see  the  strange  baro-altimeter  state  filter  prediction  error  that 
has  been  seen  in  previous  section. 
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4. 5.2. 1  Case  II,  0. 4  nm/hr  CEP  INS/Baro-Alt./P-Code  DGPS 


A  Dual-Frequency  Military  P-Code  DGPS  is  assumed  to  be  onboard  for  DGPS- 
aided  case  simulations.  As  in  the  GPS  cases,  DGPS  is  the  dominant  navigation  sensor 
onboard.  The  position  accuracy  of  DGPS  will  dictate  overall  performance  of  the 
navigation  system.  DGPS-aided  0.4nm/hr  CEP  INS  simulation  case  results  are  shown  in 
Appendix  J.  Table  IV-9  shows  lo  Latitude,  Longitude  and  Altitude  Errors  for  Case  II. 
Also  for  comparison  purpose  Britton’s  MSOLE  generated  results  for  the  same  simulation 
condition  position  errors  are  also  presented  in  Table  IV-10.  Remember  that,  Britton  [6], 
like  Gray  [10],  studied  a  precision  approach  problem  except  for  updating  the  INS  with 
DGPS.  Britton  utilized  the  same  tanker  aircraft  profile  Gray  used  in  his  thesis,  rather  than 
a  rocket  launch  profile  as  in  this  effort . 


Table  IV-9.  Case  II  1o  Latitude,  Longitude  and  Altitude  Errors 


SMSM 

Error 

State 

Number 

Position  Error 
State 

Case  II 

Mean  True  Error 
(feet) 

Case  II 

TruetTj^yg  Error 
(feet) 

Case  II 

Filter  0  ±1(7^, Error 
(feet) 

1 

51atitude 

0.13 

1.08 

1.48 

2 

51ongitude 

0.08 

0.80 

1.07 

3 

daltitude 

O.IO 

1.92 

3.75 

Table  IV-10.  Britton’s  MSOFE-generated  lo  results  for  Case  II 


SMSM  Error 
State  Number 

Position  Error 
State 

Case  II 

True  Error 

(feet) 

Case  II 

Filter  0  ±1(7^^,^^^  Error 
(feet) 

1 

dlatitude 

1.04 

1.38 

2 

dlongitude 

0.75 

1.62 

3 

Saltitude 

4.55 

5.96 
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4. 5.2.2  Case  IV,  2. 0  nm/hr  CEP  INS/Baro-Alt/P-Code  DGPS 


Case  IV  simulates  the  same  seenario  as  Case  II,  exeept  for  the  2.0  nm/hr  CEP  INS 
replaeing  the  0.4nm/hr  CEP  one  in  the  system  integration.  Again,  DGPS  is  the  dominant 
navigation  sensor.  So,  as  expeeted  in  terms  of  positioning.  Case  II  and  Case  IV  provide 
basieally  the  same  performanee.  But  if  one  eonsiders  the  tilt  and  veloeity  error  states,  it  is 
obvious  that  the  0.4  nm/hr  CEP  INS  ease  has  smaller  errors  when  eompared  to  the  2.0 
nm/hr  CEP  INS  ease.  Appendix  E  shows  the  plots  related  to  eaeh  error  state  of  Case  IV, 
and  Table  IV-1 1  shows  the  la  Eatitude,  Eongitude  and  Altitude  Errors  for  Case  IV.  Also, 
for  eomparison  purpose,  Britton’s  MSOEE-generated  results  for  the  same  simulation 
eondition  position  errors  are  also  presented  in  Table  IV-12.  Again,  remember  that  Britton 
[6],  like  Gray  [10],  studied  a  preeision  approaeh  problem  and  that  he  utilized  the  same 
tanker  aireraft  profile  Gray  used  in  his  thesis. 


Table  IV-11.  Case  IV  1a  Latitude,  Longitude  and  Altitude  Errors 


SMSM 

Error 

State 

Number 

Position  Error 
State 

Case  IV 

Mean  True  Error 
(feet) 

Case  IV 

True  Error 

(feet) 

Case  IV 

Filter  0  ±1(7^, Error 
(feet) 

1 

51atitude 

0.03 

1.39 

1.79 

2 

51ongitude 

0.13 

0.95 

1.34 

3 

daltitude 

0.04 

2.27 

4.01 
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Table  IV-12.  Britton’s  MSOFE-generated  1o  results  for  Case  IV 


SMSM  Error 
State  Number 

Position  Error 
State 

Case  IV 

True  Error 

(feet) 

Case  IV 

Filter  0  ±1(7^^,^^^  Error 
(feet) 

1 

51atitude 

1.29 

1.69 

2 

51ongitude 

0.94 

2.09 

3 

daltitude 

3.69 

6.37 

4. 5.2. 3  Case  VI,  4. 0  nm/hr  CEP  INS/Baro-Alt/P-Code  DGPS 
The  same  consideration  discussed  for  Case  II  and  IV  applies  for  Case  VI  too.  The 
difference  of  Case  VI  from  other  two  DGPS-aiding  INS  cases  is  that  Case  VI  simulates 
the  4.0  nm/hr  CEP  INS  in  the  integrated  system. 

Appendix  N  shows  the  plots  related  to  each  error  state  of  Case  VI,  and  Table 
IV-13  shows  the  la  Latitude,  Longitude  and  Altitude  Errors  for  Case  VI.  As  before, 
Britton’s  MSOLE-generated  results  for  the  same  simulation  condition  position  errors  are 
also  presented  in  Table  IV-14,  keeping  in  mind  that  Britton  [6]  used  a  tanker  aircraft 
profile  in  his  research  versus  a  rocket  launch  trajectory. 


Table  IV-13.  Case  VMo  Latitude,  Longitude  and  Altitude  Errors 


SMSM 

Error 

State 

Number 

Position  Error 
State 

Case  VI 

Mean  True  Error 
(feet) 

Case  VI 

TruetTj^yg  Error 
(feet) 

Case  VI 

Filter  0  ±1(7^, Error 
(feet) 

1 

dlatitude 

0.01 

1.49 

2.05 

2 

blongitude 

0.04 

1.04 

1.50 

3 

daltitude 

0.02 

2.19 

3.98 
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Table  IV-14.  Britton’s  MSOFE-generated  1o  results  for  Case  VI 


SMSM  Error 
State  Number 

Position  Error 
State 

Case  VI 

Truet7,^„^  Error 
(feet) 

Case  VI 

Filter  0  ±1(7^,^^^  Error 
(feet) 

1 

51atitude 

1.43 

1.87 

2 

51ongitude 

1.08 

2.31 

3 

daltitude 

3.32 

6.26 

4.6  Chapter  Summary 

This  chapter  presented  the  results  of  six  different  MatSOFE-generated  simulation 
oases  for  the  rooket  flight  profile.  Note  that  all  oases  met  and  exoeeded  the  desired 
positioning  aoouraoy.  The  overall  oomparison  of  GPS-aided  INS  oases  and  DGPS-aided 
INS  oases  are  presented  in  Tables  IV-15  and  IV-16,  respeotively.  Almost  10  months  ago, 
when  the  first  performanoe  analysis  oases  were  planned,  16  different  simulation  oases 
were  oonstruoted.  But  studying  Carrier-Phase  DGPS-aiding  INS  oases  (3  oases,  one  for 
eaoh  grade  of  INS)  quiokly  was  seen  to  be  a  substantial  overkill  in  terms  of  meeting 
position  error  specifioations.  Four  cases  related  to  implementing  a  star  traoker  as  an 
additional  measurement  into  the  navigation  system  were  postponed  to  study  as  the  last 
study  oases  if  time  permitted.  Three  oases  oonstructed  to  study  some  GPS  outages  during 
flight  were  oanoeled  due  to  the  gathered  data  out  of  WSEM  software  [2]  indioating  that 
suoh  outages  were  not  to  be  anticipated. 
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Table  IV-15.  GPS-aided  INS  Cases  Comparison  Table 


SNSM  Position 

Mean  True 

True  Error 

Eilter 

Error  States 

Error 

lo  true 

0±lo  filter 

51atitude 

0.48 

2.46 

2.84 

CASE  I 

51ongitude 

0.84 

2.45 

2.92 

daltitude 

0.25 

4.45 

6.86 

dlatitude 

0.54 

2.37 

3.28 

CASE  III 

dlongitude 

0.71 

2.43 

3.56 

daltitude 

0.18 

4.48 

6.97 

dlatitude 

0.25 

2.83 

3.76 

CASE  V 

dlongitude 

0.10 

2.94 

4.09 

daltitude 

0.19 

4.91 

6.99 

Table  IV-16.  DGPS-aided  INS  Cases  Comparison  Table 


SNSM  Position 

Mean  True 

True  Error 

Eilter 

Error  States 

Error 

1(7  TRUE 

0±la  filter 

dlatitude 

0.13 

1.08 

1.48 

CASE  II 

dlongitude 

0.08 

0.80 

1.07 

daltitude 

0.10 

1.92 

3.75 

dlatitude 

0.03 

1.39 

1.79 

CASE  IV 

dlongitude 

0.13 

0.95 

1.34 

daltitude 

0.04 

2.27 

4.01 

dlatitude 

0.01 

1.49 

2.05 

CASE  VI 

dlongitude 

0.04 

1.04 

1.50 

daltitude 

0.02 

2.19 

3.98 
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V.  Conclusions  and  Recommendations 


5.1  Conclusion 

This  chapter  presents  reeommendations  and  conelusions  based  on  the  assumptions 
made,  problems  faeed,  and  the  results  obtained,  whieh  were  presented  in  Chapter  4.  This 
ineludes  a  basie  introduction  on  the  foeus  of  the  thesis,  the  eonelusions  which  were 
drawn  from  the  experienee  gained  by  the  study  eases,  and  reeommendations  for  future 
work  whieh  may  provide  a  better  scope  to  MatSOFE. 

This  thesis  foeused  on  the  investigation  of  using  standard  and  differentially 
eorrected  GPS  data  to  improve  the  aecuraey  of  the  integrated  navigation  system  for  a 
satellite  launeh  vehiele.  A  major  aspeet  of  this  thesis  is  the  use  of  the  alternative 
performance  evaluation  tool,  MatSOFE,  as  eompared  to  the  more  typieally  used  MSOFE 
tool.  Students  who  have  utilized  MSOFE  in  their  theses  or  elass  projeets  eomplained  that 
they  were  uneomfortable  with  Fortran  and  that  most  of  the  effort  of  the  study  was  spent 
trying  to  understand  the  working  prineiples  of  MSOFE  [11],  Simulated  true  GPS  and 
DGPS  measurements  data  implementation,  and  U-D  factorization  capability  are 
augmented  to  MatSOFE  in  this  researeh.  Also,  KC-135  tanker  aireraft  and  Atlas  HAS 
launeh  profiles  are  implemented  (using  PROFGEN  [29]),  along  with  FN-93  INS  [18] 
error  model  definitions.  Furthermore,  many  former  AFIT  students’  theses  are 
reeonsidered  and  their  efforts  are  duplieated  in  a  Matlab  environment.  This  researeh  is 
the  most  eomprehensive  Matlab-based  extended  Kalman  Filter  integration  analysis  tool 
utilized  up  to  this  point  at  AFIT.  All  position  aecuraey  stipulations  are  met  in  the 
simulations.  It  has  also  seen  that  DGPS  provides  notieeable  improvement  over  standard 
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GPS.  Most  of  the  time  in  this  researeh  has  been  eonsumed  by  modifying  MatSOFE  to  its 
current  status,  to  make  sure  that  it  can  handle  this  thesis  requirements. 

The  position  errors  of  all  studied  cases  are  presented  in  Table  V-1.  When  we  take 
a  quick  look  at  the  results,  we  can  easily  say  that  all  cases  reached  and  exceeded  desired 
position  accuracy.  The  GPS-aided  INS  study  cases  results,  namely  Case  I,  III,  and  V 
results,  are  very  close  to  each  other.  The  reason  for  that  is  GPS  is  the  dominant 
navigation  sensor  in  the  system.  If  we  did  not  assume  that  there  would  be  no  GPS  outages 
during  flight,  then  these  position  errors  would  be  more  separated  from  each  other,  with 
more  impact  of  the  different  grade  INS’s  becoming  evident .  The  same  discussion  is  true 
for  the  DGPS-aiding  INS  cases. 


Table  V-1.  Results  of  All  Studied  Cases 


SNSM 

Position  Error 
States 

Mean  True 
Error 

True  Error 

lO  TRUE 

Eilter 

0±la  filter 

51atitude 

0.48 

2.46 

2.84 

CASE  I 

51ongitude 

0.84 

2.45 

2.92 

daltitude 

0.25 

4.45 

6.86 

dlatitude 

0.13 

1.08 

1.48 

CASE  II 

dlongitude 

0.08 

0.80 

daltitude 

0.10 

1.92 

3.75 

dlatitude 

0.54 

2.37 

3.28 

CASE  III 

dlongitude 

0.71 

2.43 

3.56 

daltitude 

0.18 

4.48 

6.97 

dlatitude 

0.03 

1.39 

CASE  IV 

dlongitude 

0.13 

0.95 

daltitude 

0.04 

2.27 

4.01 

dlatitude 

0.25 

2.83 

3.76 

CASE  V 

dlongitude 

0.10 

2.94 

4.09 

Saltitude 

0.19 

4.91 

6.99 

dlatitude 

0.01 

1.49 

2.05 

CASE  VI 

dlongitude 

0.04 

1.04 

1.50 

Saltitude 

0.02 

2.19 

3.98 
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5.2  Recommendations 


This  thesis  has  started  with  examining  the  work  Gray  [10]  and  Britton  [6] 
aoeomplished.  Their  aehievements  for  GPS  and  DGPS  integrated  extended  Kalman  filter 
integrations  are  eonsidered  as  the  bases  of  this  researeh. 

•  MatSOFE  is  written  without  any  aeeess  to  MSOFE.  Therefore,  it  is  believed 
by  the  author  that,  as  a  future  effort  MatSOFE  ean  be  made  more  reliable  and 
robust  Kalman  filter  evaluation  tool,  as  opposed  to  eurrent  eapabilities  it  has. 

•  The  real  emphasis  on  this  researeh  was  position  aeeuraey,  and  it  has  seen  that 
the  problem  related  to  baro-altimeter  error  state  has  no  appreeiable  impaet  on 
other  error  states.  It  is  also  believed  that  this  phenomenon  eould  be  a  result  of 
not  being  able  to  see  the  original  MSOFE  eode. 

•  The  INS  performanee  is  a  little  bit  disregarded  sinee  no  GPS  outage  during 
flight  was  one  of  the  assumptions  and  GPS  aeeuraey  is  superior  over  INS. 

•  It  was  not  neeessary  for  this  thesis,  but  for  future  usage,  earrier-phase  GPS 
signals  ean  be  implemented  to  inerease  the  aeeuraey  of  the  GPS 
measurements  to  the  eentimeter  level  for  neeessary  navigation  problems.  A 
viable  earrier-phase  model  was  not  available  for  the  MatSOFE  paekage  during 
this  study.  If  time  allowed,  developing  and  utilizing  sueh  an  aeeurate 
measurement  system,  would,  perhaps  make  MatSOFE  one  of  the  best  and 
most  versatile  performanee  evaluation  tools  available. 

•  Aeeording  to  reviewed  literature,  the  navigation  sensor  used  in  Atlas  HAS  is 
only  INS  [15].  Also,  there  are  some  other  launeh  vehieles  using  GPS-aided 
INS  navigation  system.  At  the  very  beginning  of  this  study,  it  was  quite  elear 
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that  even  the  worst  ease  of  this  study  (CASE  I,  GPS-aided  0.4  nm/hr  CEP 
INS)  would  meet  and  exceed  the  position  requirements.  The  only  reason  for 
incorporating  DGPS  measurements  into  system  was  to  make  MatSOEE  a 
more  useful  and  reliable  filter  performance  evaluation  tool  in  the  future.  In 
reality  incorporating  DGPS  measurements  would  not  be  enough.  The 
reference  receiver  positioning  and  means  of  differential  corrections  should 
also  be  included  inside  the  research  scope,  but  this  was  not  pursued  here 
because  of  the  good  non-differential  GPS-aided  INS  performance. 
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Appendix  A 

Error  State  Definitions  for  the  SNSM  Truth  and  Filter  Models 

Tabular  listings  of  the  truth  and  filter  models  are  presented.  Tables  A-1  and  A-2 
show  the  39  INS  states  for  the  truth  model,  with  the  SNU  84-1  [Litton, 18]  and  LSM  [10] 
and  DLSM  [6]  state  numbers  given  for  cross-referenee.  Table  A-3  lists  the  GPS  states 
and  Table  A-4  lists  DGPS  states  respectively,  and  finally  Table  A-5  lists  the  states  in  the 
reduced-ordered  SNSM  fdter  model. 
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Table  A-1 .  39-State  INS  System  Model:  First  20  States 


SNSM 

State 

State 

Symbol 

Definition 

LITTON 

State 

LSM 

State 

DLSM 

State 

1 

50X 

X-eomponent  of  veetor  angle  from  true  to  eomputer 
frame 

1 

1 

1 

2 

SOy 

Y-eomponent  of  veetor  angle  from  true  to  eomputer 
frame 

2 

2 

2 

3 

56z 

Z-eomponent  of  veetor  angle  from  true  to  eomputer 
frame 

3 

3 

3 

4 

(|^X 

X-  eomponent  of  veetor  angle  from  true  to  platform 
frame 

4 

4 

4 

5 

(^y 

Y-  eomponent  of  veetor  angle  from  true  to  platform 
frame 

5 

5 

5 

6 

Z-  eomponent  of  veetor  angle  from  true  to  platform 
frame 

6 

6 

6 

7 

5Vx 

X-eomponent  of  error  in  eomputed  veloeity 

7 

7 

7 

8 

5Vy 

Y -eomponent  of  error  in  eomputed  veloeity 

8 

8 

8 

9 

5Vz 

Z-eomponent  of  error  in  eomputed  veloeity 

9 

9 

9 

10 

8h 

Error  in  vehiele  altitude  above  referenee  ellipsoid 

10 

10 

10 

11 

5hB 

Total  baro-altimeter  eorrelated  error 

23 

11 

11 

14 

8hL 

Error  in  lagged  inertial  altitude 

11 

14 

14 

15 

5S3 

Error  in  vertieal  ehannel  aiding  state 

12 

15 

15 

16 

5S4 

Error  in  vertieal  ehannel  aiding  state 

13 

16 

16 

17 

Axc 

X-eomponent  of  aeeelerometer  and  veloeity 
quantizer  eorrelated  noise 

17 

17 

17 

18 

Aye 

Y -eomponent  of  aeeelerometer  and  veloeity 
quantizer  eorrelated  noise 

18 

18 

18 

19 

Azc 

Z-eomponent  of  aeeelerometer  and  veloeity 
quantizer  eorrelated  noise 

19 

19 

19 

20 

5gx 

X-eomponent  of  gravity  veetor  errors 

20 

20 

20 

21 

Sgy 

Y-eomponent  of  gravity  veetor  errors 

21 

21 

21 

22 

5gz 

Z-eomponent  of  gravity  veetor  errors 

22 

22 

22 

Note:  SNSM  state  12  and  state  13  are  loeated  in  Table  A-3  and  Table  A-4 
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Table  A-2.  39-state  INS  System  Model:  Second  19  States 


SNSM 

State 

Definition 

LITTON 

State 

Symbol 

State 

DLSM 

State 


23 

bx 

X-eomponent  of  gyro  drift  rate  repeatability 

30 

23 

23 

24 

by 

Y-eomponent  of  gyro  drift  rate  repeatability 

31 

24 

24 

25 

bz 

Z-eomponent  of  gyro  drift  rate  repeatability 

32 

25 

25 

26 

Sgx 

X-eomponent  of  gyro  seale  faetor  error 

33 

26 

26 

27 

^gy 

Y-eomponent  of  gyro  seale  faetor  error 

34 

27 

27 

28 

Sgz 

Z-eomponent  of  gyro  seale  faetor  error 

35 

28 

28 

29 

Vbx 

X-eomponent  of  aeeelerometer  bias  repeatability 

48 

29 

29 

30 

Vby 

Y-eomponent  of  aeeelerometer  bias  repeatability 

49 

30 

30 

31 

Vbz 

Z-eomponent  of  aeeelerometer  bias  repeatability 

50 

31 

31 

32 

Sax 

X-eomponent  of  aeeelerometer  and  veloeity 

quantizer  scale  factor  error 

51 

32 

32 

33 

Say 

Y-component  of  accelerometer  and  velocity 

quantizer  scale  factor  error 

52 

33 

33 

34 

Saz 

Z-component  of  accelerometer  and  velocity 

quantizer  scale  factor  error 

53 

34 

34 

35 

SqAx 

X-component  of  accelerometer  and  velocity 

quantizer  scale  factor  asymmetry 

54 

35 

35 

36 

SqAy 

Y-component  of  accelerometer  and  velocity 

quantizer  scale  factor  asymmetry 

55 

36 

36 

37 

SqAz 

Z-component  of  accelerometer  and  velocity 

quantizer  scale  factor  asymmetry 

56 

37 

37 

38 

X  accelerometer  misalignment  about  Z-axis 

66 

38 

38 

39 

^2 

Y  accelerometer  misalignment  about  Z-axis 

67 

39 

39 

40 

113 

Z  accelerometer  misalignment  about  X-axis 

68 

40 

40 

41 

(^3 

Z  accelerometer  misalignment  about  Y-axis 

69 

41 

41 
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Table  A-3.  30-State  GPS  System  Model 


SNSM 

State 

— il 

Definition 

LSM  State 

DLSM  State 

12 

5Rclku 

User  cloek  bias 

12 

12 

13 

SDclku 

User  elock  drift 

13 

13 

42 

SRcloopl 

SV  1  eode  loop  error 

42 

- 

43 

SRtropl 

SV  1  tropospherie  error 

43 

43 

44 

§Rionl 

SV  1  ionospherie  error 

44 

44 

45 

SRclksvl 

SV  1  elock  error 

45 

- 

46 

5xsvl 

SV  1  x-component  of  position  error 

46 

46 

47 

§ysvl 

SV  1  y-component  of  position  error 

47 

47 

48 

5zsvl 

SV  1  z-component  of  position  error 

48 

48 

49 

§Rcloop2 

SV  2  code  loop  error 

49 

- 

50 

SRtrop2 

SV  2  tropospheric  error 

50 

50 

51 

5Rion2 

SV  2  ionospheric  error 

51 

51 

52 

5Rclksv2 

SV  2  clock  error 

52 

- 

53 

5xsv2 

SV  2  x-component  of  position  error 

53 

53 

54 

§ysv2 

SV  2  y-component  of  position  error 

54 

54 

55 

5zsv2 

SV  2  z-component  of  position  error 

55 

55 

56 

5Rcloop3 

SV  3  code  loop  error 

56 

- 

57 

5Rtrop3 

SV  3  tropospheric  error 

57 

57 

58 

5Rion3 

SV  3  ionospheric  error 

58 

58 

59 

§Rclksv3 

SV  3  clock  error 

59 

- 

60 

§Xsv3 

SV  3  x-component  of  position  error 

60 

60 

61 

§ysv3 

SV  3  y-component  of  position  error 

61 

61 

62 

§Zsv3 

SV  3  z-component  of  position  error 

62 

62 

63 

SRcloopl 

SV  4  code  loop  error 

63 

- 

64 

SRtrop4 

SV  4  tropospheric  error 

64 

64 

65 

5Rion4 

SV  4  ionospheric  error 

65 

65 

66 

5Rclksv4 

SV  4  clock  error 

66 

- 

67 

5Xsy4 

SV  4  x-component  of  position  error 

67 

67 

68 

5ysv4 

SV  4  y-component  of  position  error 

68 

68 

69 

5zsv4 

SV  4  z-component  of  position  error 

69 

69 
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Table  A-4.  22-State  DGPS  System  Model 


SNSM 

State 

— il 

Definition 

LSM  State 

DLSM  State 

12 

5Rclku 

User  clock  bias 

12 

12 

13 

5Dclku 

User  clock  drift 

13 

13 

42 

SRtropl 

SV  1  tropospheric  error 

43 

43 

43 

SRionl 

SV  1  ionospheric  error 

44 

44 

44 

5xsvl 

SV  1  x-component  of  position  error 

46 

46 

45 

§ysvl 

SV  1  y-component  of  position  error 

47 

47 

46 

5zsvl 

SV  1  z-component  of  position  error 

48 

48 

47 

SRtrop2 

SV  2  tropospheric  error 

50 

50 

48 

5Rion2 

SV  2  ionospheric  error 

51 

51 

49 

5xsv2 

SV  2  x-component  of  position  error 

53 

53 

50 

5ysv2 

SV  2  y-component  of  position  error 

54 

54 

51 

5zsv2 

SV  2  z-component  of  position  error 

55 

55 

52 

5Rtrop3 

SV  3  tropospheric  error 

57 

57 

53 

5Rion3 

SV  3  ionospheric  error 

58 

58 

54 

5xsv3 

SV  3  x-component  of  position  error 

60 

60 

55 

5ysv3 

SV  3  y-component  of  position  error 

61 

61 

56 

5zsv3 

SV  3  z-component  of  position  error 

62 

62 

57 

§Rtrop4 

SV  4  tropospheric  error 

64 

64 

58 

5Rion4 

SV  4  ionospheric  error 

65 

65 

59 

5Xsy4 

SV  4  x-component  of  position  error 

67 

67 

60 

5ysv4 

SV  4  y-component  of  position  error 

68 

68 

61 

5zsv4 

SV  4  z-component  of  position  error 

69 

69 
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Table  A-5.  13-State  Reduced-Order  Filter  Model 


SNSM 

State 

IHl 

Definition 

LSM 

State 

DLSM 

State 

1 

SOx 

X-component  of  vector  angle  from  true  to  computer  frame 

1 

1 

2 

SGy 

Y-component  of  vector  angle  from  true  to  computer  frame 

2 

2 

3 

86z 

Z-component  of  vector  angle  from  true  to  computer  frame 

3 

3 

4 

(|^X 

X-  component  of  vector  angle  from  true  to  platform  frame 

4 

4 

5 

(^y 

Y-  component  of  vector  angle  from  true  to  platform  frame 

5 

5 

6 

Z-  component  of  vector  angle  from  true  to  platform  frame 

6 

6 

7 

5Vx 

X-component  of  error  in  computed  velocity 

7 

7 

8 

5Vy 

Y -component  of  error  in  computed  velocity 

8 

8 

9 

5Vz 

Z-component  of  error  in  computed  velocity 

9 

9 

10 

5h 

Error  in  vehicle  altitude  above  reference  ellipsoid 

10 

10 

11 

5hB 

Total  baro-altimeter  correlated  error 

11 

11 

12 

5clkb 

User  clock  bias 

12 

12 

13 

5clk(ji- 

User  clock  drift 

13 

13 
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Appendix  B 

Dynamics  Matrices  and  Noise  Values 

B.l  Definition  of  Dynamics  Matrices 

In  Chapter  3,  the  truth  and  filter  model  dynamics  are  defined  by  the  submatrices, 
^Filter ,  ’  ^ud  of  Equation  (3.5).  The  ^ pater  represents  the  filter 

dynamics  matrix,  which  is  also  a  submatrix  of  the  larger  truth  model  dynamics  matrix 
[27].  The  other  three  matrices  represent  the  additional  truth  model  non-zero  portions  of 
the  F  matrix  that  simulate  the  real  world  [27,33].  Tables  B-2,  B-3,  B-4,  B-5,  and  B-6 
contain  the  non-zero  elements  of  the  dynamics  submatrices  ^ pater  ■,  F/^s,  >  F^^^  ^ ,  F^^^^  , 
and  Fjjgp^  ,  respectively.  All  undeclared  variables  shown  in  the  following  tables  are 

defined  in  the  LN-93  technical  report,  along  with  their  units  [18,27].  The  structure  of  the 
dynamics  matrices  in  this  chapter  correspond  to  the  truth  model  state  definitions  in 
Appendix  A  and  to  the  AFIT  thesis  (LSM/DLSM  model)  by  [6,10].  The  notation  used  in 
Table  B-2  through  Table  B-4in  this  Appendix  is  defined  in  Table  B-1. 
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Table  B-1 .  Notation  of  Variables  used  in  Table  B-2  to  Table  B-4 


Px,  Py,  Pz 

Components  of  angular  rate  of  navigation  frame  with  respeet  to 

the  earth  (craft  rate),  coordinatized  in  Litton  True  frame 

Components  of  earth  sidereal  rate  vector  (earth  rate), 

coordinatized  in  Litton  ECEF,  with  respect  to  inertial  space 

(15.041067  deg/hr) 

a 

Equatorial  radius  of  the  earth  (6378388  meters) 

go 

Equatorial  gravity  magnitude  (32.08744  ft/sec^) 

®ity,  ®itz 

Components  of  angular  rate  of  body  frame  with  respect  to  inertial 

space  (spatial  rate),  coordinatized  in  Eitton  True  frame 

VxVyV, 

Components  of  vehicle  velocity  vector  with  respect  to  earth-fixed 

coordinates 

^x,  ^y,  ^z 

Components  of  specific  force,  coordinatized  in  Eitton  True  frame 

Crx,  Cry 

Components  of  earth  spheroid  inverse  radii  of  curvature 

^ibx,  ^iby,  ^ibz 

Components  of  angular  rate  of  body  frame  with  respect  to  inertial 

space  (spatial  rate),  coordinatized  in  Eitton  Body  frame 

Cio 

Elements  of  the  transformation  matrix 

P5hc 

Barometer  inverse  correlation  time  (600  seconds) 

PVxc,  PVyc,  PVzc 

Accelerometer  inverse  correlation  time  constants  (5  minutes) 

P5gx,  P5gy,  P5gz 

Gravity  vector  error  inverse  correlation  time  constants 

(Velocity/correlation  distance) 

^Shc 

Variance  of  barometer  correlated  noise 

^^xc’  ^^yc’ 

Variances  of  accelerometer  correlated  noise 

^Sgx’  ^Sgy’  ^Sgz 

Variances  of  gravity  vector  correlated  noise 

rp-  r?  r? 

^rjhx^  ^Tjby’^Tjbz 

Power  spectral  density  value  of  gyro  drift  rate  white  noise 

rP  rP  rP 

^tjAx  ’  ^TjAy  ’  ^tjAz 

Power  spectral  density  value  of  accelerometer  white  noise 

kb  k2,  k3,  k4 

Vertical  channel  gains  (see  figure  2  of  [18]) 
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Table  B-2.  Elements  of  the  Dynamics  Submatrix 


Element 

Variable 

Element 

Variable 

(1,3) 

-py 

(1,8) 

-CRY 

(2,3) 

px 

(2,7) 

CRX 

(3,1) 

py 

(3,2) 

-px 

(4,2) 

-Q.Z 

(4,3) 

Q.y 

(4,5) 

(Oitz 

(4,6) 

-(Oity 

(4,8) 

-CRY 

(5,1) 

Q.Z 

(5,3) 

-Q.X 

(5,4) 

-(Oitz 

(5,6) 

(Oitx 

(5,7) 

CRX 

(6,1) 

-Q.y 

(6,2) 

Q.X 

(6,4) 

(Oity 

(6,5) 

-(Oitx 

(7,1) 

-2VyD.y-2YzQ.z 

(7,2) 

2Vyax 

(7,3) 

2VzQ.x 

(7,5) 

-Az 

(7,6) 

Ay 

(7,7) 

-VzCRX 

(7,8) 

2Q.Z 

(7,9) 

-py-2ay 

(8,1) 

2YxQ.y 

(8,2) 

2Vxnx-2Vznz 

(8,3) 

2VzQ.y 

(8,4) 

Az 

(8,6) 

-Ax 

(8,7) 

-2Q.Z 

(8,8) 

-VzCRY 

(8,9) 

^x+2Q.x 

(9,1) 

2VxQ.z 

(9,2) 

2YyQ.z 

(9,3) 

-2VyQy-2VxQx 

(9,4) 

-Ay 

(9,5) 

Ax 

(9,7) 

py2ay+VxCRX 

(9,8) 

-px-2ax+VyCRY 

(9,10) 

2go/a 

(10,9) 

1 

(9,11) 

k2 

(10,11) 

kl 

(11,11) 

-(35hc 

(12,13) 

1 

Table  B-3.  Elements  of  the  Dynamics  Submatrix 


Element 

Variable 

Element 

Variable 

Element 

Variable 

(9,14) 

-k2 

(9,15) 

-1 

(9,16) 

k2 

(10,14) 

-kl 

(10,16) 

ki-1 

(14,10) 

1 

(14,14) 

-1 

(15,14) 

k3 

(15,16) 

-k3 

(16,10) 

k4 

(16,14) 

-k4 

(7,17) 

Cll 

(7,18) 

Cl2 

(7,19) 

Cl3 

(7,20) 

1 

(8,17) 

C21 

(8,18) 

C22 

(8,19) 

C23 

(8,21) 

1 

(9,17) 

C3I 

(9,18) 

C32 

(9,19) 

C33 

(9,22) 

1 

(16,11) 

k4/600 

(16,16) 

k4-l 

(15,11) 

-k3 

(4,23) 

Cll 

(4,24) 

C12 

(4,25) 

Cl3 

(4,26) 

Cl  ItOibx 

(4,27) 

Cl2tOiby 

(4,28) 

Cl3(Oibz 

(5,23) 

C21 

(5,24) 

C22 

(5,25) 

C23 

(5,26) 

C210)ibx 

(5,27) 

C220)iby 

(5,28) 

C230)iby 

(6,23) 

C31 

(6,24) 

C32 

(6,25) 

C33 

(6,26) 

C310)ibx 

(6,27) 

C32tOiby 

(6,28) 

C330)iby 

(7,29) 

Cll 

(7,30) 

C12 

(7,31) 

Cl3 

(7,32) 

Cii^f 

(7,33) 

Cl2< 

(7,34) 

C134^' 

(7,35) 

Cll 

(7,36) 

C12 

(7,37) 

Cl3 

Af 

(7,38) 

Cl2< 

1 

(7,39) 

Cll /if 

1 

(7,40) 

Cl3< 

(7,41) 

(8,29) 

C21 

(8,30) 

C22 

(8,31) 

C23 

(8,32) 

C2\A^ 

(8,33) 

C22< 

(8,34) 

C23Af 

(8,35) 

C2I 

(8,36) 

C22 

Ay 

(8,37) 

C23 

Af 

■ 

1 

(8,38) 

C22< 

1 

(8,39) 

C2I  Af 

(8,40) 

C23< 

1 

(8,41) 

C23Af 

1 

(9,29) 

C3I 

(9,30) 

C32 

(9,31) 

C33 

(9,32) 

C314^ 

(9,33) 

C32< 

(9,34) 

C33 

(9,35) 

C31 

A^ 

(9,36) 

C32 

Ay 

1 

(9,37) 

C33 

4^' 

1 

(9,38) 

C3 1  Af 

(9,39) 

-C32Af 

1 

(9,40) 

C33< 

1 

(9,41) 

C33Af 

Table  B-4.  Elements  of  the  Dynamics  Submatrix 


Element 

Variable 

(17,17) 

"PVxe  ~  -3.33E-3  sec~^ 

(18,18) 

"PVyc  ~  -3.33E-3  sec~^ 

(19,19) 

"PVze  ~  -3.33E-3  sec”^ 

(20,20) 

-P5gx  =  -8.22E-6*'Jl^^  +  Vy  +V^  sec 

(21,21) 

-P5gy  =  -8.22E-6*  +  if  +  if  sec~^ 

(22,22) 

-P5gz  =  -8.22E-6*f  if  +  if  +  if  sec~^ 

Note:  For  the  above  element  definitions  (T ables  B-2,  2,  4)  to  =  0 

-PVxc,yc,zc  =  Accelerometer  inverse  time  eonstant  (5  min) 

-P8gx  ,gy,gz  =  Gravity  veetor  inverse  eorrelation  time  eonstant  (V/20  NM) 
-PSho  =  Barometer  inverse  eorrelation  time  (600  see) 

Components  of  aeeeleration  in  the  body  frame 
Speeifie  foree  eomponent 

Transformation  matrix  from  body  frame  to  navigation  frame, 


A 

C 


x,y,z 

B' 
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Table  B-5.  Elements  of  the  Dynamics  Submatrix 


Element 

Variable 

Element 

Variable 

Element 

Variable 

(42,42) 

-1  ft'^  1  sec 

(43,43) 

-1/500  ft^lsee 

(44,44) 

-1/1500  ft^/ sec 

(49,49) 

-1  ft^  1  sec 

(50,50) 

-1/500  ft^  1  see 

(51,51) 

-1/1500  ft^/ sec 

(56,56) 

-1  ft^  1  sec 

(57,57) 

-1/500  ft^  /  see 

(58,58) 

-1/1500  ft^/ sec 

(63,63) 

-1  ft^  1  sec 

(64,64) 

-1/500  ft^  /  see 

(65,65) 

-1/1500  ft^/ sec 

Table  B-6.  Elements  of  the  Dynamics  Submatrix 


Element 

Variable 

Element 

Variable 

(43,43) 

-1/500  ft^  !  see 

(44,44) 

-1/1500  /sec 

(50,50) 

-1/500  ft^  !  see 

(51,51) 

-1/1500  /sec 

(57,57) 

-1/500  ft^  !  see 

(58,58) 

-1/1500  /sec 

(64,64) 

-1/500  ft^lsee 

(65,65) 

-1/1500  /sec 
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B.2  Elements  of  the  Process  Noise  and  Measurement  Noise  Matrices 

This  section  defines  the  dynamic  noise  strengths  and  measurement  noise 
variances  for  the  truth  and  filter  models.  The  truth  model  non-zero  dynamics  noise 
strengths  are  defined  in  Tables  B-7  through  B-12.  These  noise  strengths  correspond  to  the 
driving  noises  Wp,Qp^^  and  in  Equation  (3.5).  Note  that  the  (4,4) 

through  (9,9)  terms  in  Table  B-7  are  variable  names  as  defined  in  the  Litton  technical 
report  [18]  and  do  not  represent  variance  terms  typically  associated  with  the  notation 
[6,10].  They  are  actually  the  heights  of  Power  Spectral  Density  (PSD)  functions 
associated  with  each  white  noise.  However,  the  terms  in  “2(3i  o?-  ”  in  (1 1,1 1)  through 
(24,24)  are  real  variances  (of  the  outputs  of  first  order  lag  shaping  filters).  The  filter 
dynamics  driving  noise  terms  implemented  after  filter  tuning  for  each  respective  INS 
integration  (0.4  nm/hr,  2.0  nm/hr  and  4.0  nm/hr)  is  listed  in  Table  B-10,  Table  B-1 1,  and 
Table  B-12.  Finally,  the  measurement  noise  variances  used  in  the  truth  and  filter  models 
are  presented  in  Table  B-13. 
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Table  B-7.  Elements  of  Truth  Model  Process  Noise  Submatrix  for  the  INS  Truth  Model 


Eleme 

nt 

Variable 

Elemen 

t 

Variable 

Element 

Variable 

(4,4) 

oi  =190.4E-15 

'Ibx 

[/^Vsec^] 

(5,5) 

ol  =190.4E-15 

'Iby 

[/f'/sec'l 

(6,6) 

oi  =190.4E-15 

'Ibz 

[/^Vsec^] 

(7,7) 

=  102.9E-9 

[/f"/sec'] 

(8,8) 

oi  =  102.9E-9 

nAy 

[/fVsec'l 

(9,9) 

ol  =  102.9E-9 

UAz 

[/fVsec'l 

(19,1 

9) 

=  2.75E-11 
[/fVsec'l 

(20,20) 

^Pvyc^yc 
=  2.75E-11 
[/f'/sec'l 

(21,21) 

'^Pvzc^zc 
=  2.75E-11 

[/fVsec'l 

(22,2 

2) 

'^^dgx^dgx 

=  3.10E-13 
[/f"/sec'] 

(23,23) 

'^fisgy^Sgy 
=  3.10E-13 
[/f'/sec'l 

(24,24) 

'^Psgz^Sgz 
=  3.10E-13 
[/f'/sec'l 

(11,11) 

She  ^Shc 
=  33.34 

[/z'Vsec] 
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Table  B-8.  Elements  of  Truth  Model  Process  Noise  for  GPS  States 


Element 

Variable 

Element 

Variable 

Element 

Variable 

(42,42) 

0.5  fP'  /  sec 

(43,43) 

0.004 fP  /  sec 

(44,44) 

0.004  fP  /  sec 

(49,49) 

0.5  fP  /  sec 

(50,50) 

0.004  fP  1  sec 

(51,51) 

0.004  fP  /  see 

(56,56) 

0.5  fP  /  sec 

(57,57) 

0.004  fP  1  see 

(58,58) 

0.004  fP  /  sec 

(63,63) 

0.5  fP  /  sec 

(64,64) 

0.004 fP  /sec 

(65,65) 

0.004  fP  /sec 

Table  B-9.  Elements  of  Truth  Model  Process  Noise  for  DGPS  States 


Element 

Variable 

Element 

Variable 

(43,43) 

0.001  fP  /  see 

(44,44) 

0.0004  fP  /  see 

(50,50) 

0.001  fP  /  see 

(51,51) 

0.0004  fP  /see 

(57,57) 

0.001  fP  /  see 

(58,58) 

0.0004  fP  /  see 

(64,64) 

0.001  fP  /  see 

(65,65) 

0.0004  fP  /  see 
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Table  B-10.  Filter  Process  Noise  Q  Values  for  Case  Using  the  0.4  nm/hr  INS 


Element 

Variable 

Element 

Variable 

(1,1) 

7.5E-16  rad^/sec 

(2,2) 

7.0E-16  rad^/sec 

(3,3) 

0.0  rad^/sec 

(4,4) 

190.4E-15rad^/sec 

(5,5) 

190.4E-15  rad^/sec 

(6,6) 

85.2E-15rad^/sec 

(7,7) 

5.15E-8  ft^/sec^ 

(8,8) 

2.06E-8  ft^/sec^ 

(9,9) 

25,000.0  ft^/sec^ 

(10,10) 

450.0  ft^/sec 

(11,11) 

833.5  ft^/sec 

(12,12) 

3.5  ft^/sec 

(13,13) 

5.0E-15  ft^/sec^ 

Table  B-1 1 .  Filter  Process  Noise  Q  Values  for  Cases  Using  the  2.0  nm/hr  INS 


Element 

Variable 

Element 

Variable 

(1,1) 

7.5E-16  rad^/sec 

(2,2) 

7.5E-16  rad^/sec 

(3,3) 

0.0  rad^/sec 

(4,4) 

2.85E-11  rad^/sec 

(5,5) 

2.85E-11  rad^/sec 

(6,6) 

2.85E-9  rad^/sec 

(7,7) 

2.06E-5  ft^/sec^ 

(8,8) 

2.06E-5  ft^/sec^ 

(9,9) 

5,000.0  ft^/sec^ 

(10,10) 

850.0  ft^/sec 

(11,11) 

833.5  ft^/sec 

(12,12) 

3.5  ft^/sec 

(13,13) 

5.0E-15  ft^/sec^ 

Table  B-1 2.  Filter  Process  Noise  Q  Values  for  Cases  Using  the  4.0  nm/hr  INS 


Element 

Variable 

Element 

Variable 

(1,1) 

7.5E-16  rad^/sec 

(2,2) 

7.5E-16  rad^/sec 

(3,3) 

0.0  rad^/sec 

(4,4) 

3.33E-10rad^/sec 

(5,5) 

3.33E-10rad^/sec 

(6,6) 

5.7E-13  rad^/sec 

(7,7) 

2.57E-5  ft^/sec^ 

(8,8) 

2.57E-5  ft^/sec^ 

(9,9) 

5,000.0  ft^/sec^ 

(10,10) 

700  ft^/sec 

(11,11) 

933.5  ft^/sec 

(12,12) 

4.0  ft^/sec 

(13,13) 

5.0E-16  ft^/sec^ 
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Table  B-13.  Truth  and  Filter  Measurement  Noise  R  Values  for  Cases 


Measurement 

Truth  Noise 

Filter  Noise 

Satellite  Vehicles  (GPS) 

16  ft^ 

75  ft^ 

Satellite  Vehicles  (DGPS) 

9ft^ 

30  ft^ 
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Appendix  C 
PROF  IN  Input  File 


GROUP  1,  General  Information 


prof_in 


*  prof_in  is  the  input  file  for  PROFGEN.  This  self-documenting  file 
contains  controls  that  specify  flight  conditions  and  maneuvers. 

prof_in  is  divided  into  three  GROUPS  with  contents  as  follows: 

GROUP  1:  General  Information; 

GROUP  2:  Problem  Control  Parameters,  echoed  in  Table  1  of  PROF_OUT; 
GROUP  3:  Segment  Control  Parameters,  echoed  in  Table  2  of  PROF_OUT. 
All  data  are  entered  in  list  directed  format. 

*  Each  GROUP  is  composed  of  a  REMINDER  followed  by  several  parameters. 
The  REMINDER  describes  the  GROUP  and  should  not  be  altered. 

Assign  parameter  values  appropriate  to  your  specific  problem. 

*  In  GROUPS  1  and  2,  parameters  are  presented  in  a  NOTE-value  style. 

The  NOTE,  delimited  in  single  quotes,  briefly  defines  the  parameter 
and  the  value  follows  the  NOTE.  Together  they  look  like  this: 

'NAME  TYPE  DESCRIPTION  UNITS  DEFAULT'  value 

*  In  GROUP  3,  parameters  are  presented  in  a  worksheet  style. 


'PTITLE  CH*80  PROFGEN  run  title  -  "no  title"  ' 

'Atlas  HAS  Two-stage  rocket  mission.  Cape  Canaveral  to  low-Earth  orbit,  low 
fidelity ' 


II  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  = 

GROUP  2,  Problem  Control  Parameters 


*  Logical  parameters  IN_MET,  PO_MET  and  FO_MET  specify  which  of  two  units 
systems  to  use  for  I/O.  When  true,  meters,  kilograms  and  seconds  (m_kg_s) 
are  used,  and  when  false,  feet,  pounds-mass  and  seconds  (ft_p_s)  are  used. 


*  This  table  summarizes  how  the  three  XX_MET  parameters  are  applied: 


IN_MET  1 

prof_in 

PO_MET  1 

PROF_OUT 

FO_MET  1 

FLY_OUT 

true  1 

false  1 

m_kg_s_deg 

ft_p_s_deg 

true  1 

false  1 

m_s_deg 
f t_s_deg 

true  1 

false  1 

m_s_rad 

ft_s_rad 

Figure  C-1 .  PROFJN  Input  File  for  PROFGEN 
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*  Parameters  PO_VAR  and  FO_VAR  specify  which  of  53  variables  to  output 
to  PROF_OUT  and  FLY_OUT .  Indices  for  all  53  available  variables  are 
given  in  the  following  ordered  list: 


1 

GLON 

GLAT 

ALT 

CLON 

ALPHA 

HEAD 

ROLL 

PITCH 

W_HDG 

10 

dGLON 

dGLAT 

dALT 

dCLON 

dALPHA  dHEAD 

dROLL 

dPITCH 

dW_HDG 

19 

Vs 

dVs 

21 

Ri 

Vi 

Vli 

GNi 

Fli 

WBIi 

Gib 

Cie 

WEIe 

30 

Re 

Ve 

Vie 

Ge 

Fie 

WBIe 

Ceb 

Cen 

WNEn 

39 

Rn 

Vn 

VIn 

Gn 

Fin 

WBIn 

Cnb 

Cni 

WBNb 

48 

Rb 

Vb 

VIb 

Gb 

Fib 

WBIb 

NAME 

TYPE 

DESCRIPTION  UNITS 

DEFAULT 

value 

"Problem 

specs 

' IN_MET 

LG 

prof_in  metric,  else  British  - 

•  T. 

'  / 

' WAMECH 

IN 

wander  angle  mechanization  index: 

1  constant  alpha  2  alpha  wander 

3  unipolar  4  free  azimuth  - 

1 

'  2 

'  RHUMB 

LG 

rhumb  line  path,  else  great  circle  - 

.T. 

'  .f . 

'  RTOL 

DP 

relative  tolerance  for  integration  - 

1  .D-12 

'  / 

'  ATOL 

DP 

absolute  tolerance  for  integration  - 

1  .D-12 

'  / 

"Earth 

constants 

'ESQ 

DP 

earth  eccentricity  squared 

-  6 

.  69437999014D-3 ' 

/ 

'  REQ 

DP 

earth  semimajor  axis 

m 

6.378137D6 

/ 

'WEI 

DP 

earth  sidereal  rate 

rad/ s 

7.292115D-5 

/ 

'  GM 

DP 

earth  gravitational  constant 

m3/ s2 

3 . 986004418D14  ' 

/ 

'  GEE 

DP 

scales  PACC&TACC  to  accel  units 

m/s2 /g 

ee  9.8 

/ 

'  RHOSL 

DP 

air  density  at  sea  level 

kg/m3 

1.225 

/ 

'  ZETA 

DP 

exponent  in  air  density  function 
rho  =  RHOSL  *  exp(-ZETA  *  alt) 

1/m 

1.1385D-4 

/ 

"Vehicle 

specs 

' ROLRAT 

DP 

maximum  roll  rate 

deg/ s 

1  .DO 

'  / 

!  no  vehicle 

' ROLTC  DP 

parameter  is  used 
roll-axis  time  constant 

sec 

1  .DO 

'  / 

' VMASS 

DP 

vehicle  mass 

kg 

1  .DO 

'  / 

' RAREA 

DP 

reference  area  for  drag 

m2 

1  .DO 

'  / 

' CDRAG 

DP 

coefficient  of  drag 

- 

1  .DO 

'  / 

Figure  C-1  (cent).  PROF_IN  Input  File  for  PROFGEN 
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"State  initial  conditions 


T START 

DP 

initial 

time  of  trajectory 

sec 

0  .DO 

'  / 

VsO 

DP 

initial 

speed 

m/  s 

0  .DO 

'  / 

ROLLO 

DP 

initial 

roll  angle 

deg 

0  .DO 

'  / 

PITCHO 

DP 

initial 

pitch  angle 

deg 

0  .DO 

'  89. 

HEADO 

DP 

initial 

ground  path  heading 

deg 

0  .DO 

'  90 . 

ALPHAO 

DP 

initial 

wander  angle 

deg 

0  .DO 

'  / 

GLATO 

DP 

initial 

geodetic  latitude 

deg 

0  .DO 

'  28.5 

GLONO 

DP 

initial 

geodetic  longitude 

deg 

0  .DO 

'  -81.0 

CLONO 

DP 

initial 

celestial  longitude 

deg 

0  .DO 

'  / 

ALTO 

DP 

initial 

altitude 

m 

0  .DO 

'  / 

"Output 

controls 

'  PO_X 

IN 

print  (PROF_OUT  file)  control  - 

1 

I 

1 

o 

1 

X 

IN 

write  (FLY_OUT  file)  control  - 

0 

I 

1 

' PO_MET 

LG 

PROF_OUT  metric,  else  British  - 

.  T . 

I 

.f  . 

' FO_MET 

LG 

FLY_OUT  metric,  else  British  - 

.  T . 

I 

.f  . 

'  DELR 

DP 

spread  in  roll  between  outputs  deg 

0  .DO 

I 

/ 

'  DELP 

DP 

spread  in  pitch  between  outputs  deg 

0  .DO 

I 

/ 

'  DELY 

DP 

spread  in  heading  between  outputs  deg 

0  .DO 

I 

/ 

' PO_SEP 

DP 

min  separation  in  PROF_OUT  outputs  sec 

0  .DO 

I 

/ 

' FO_SEP 

DP 

min  separation  in  FLY_OUT  outputs  sec 

0  .DO 

I 

/ 

' WGSaxes 

LG 

coordinate  frame  set  - 

.  T  . 

true:  e=  WGS-84,  g=  E-N-U,  ...  b=  nose-rt_wing-down 
false:  e=  SNU-84,  g=  N-W-U,  ...  b=  nose-rt_wing-down  ' 

/ 

' PO_VAR 

IN (53)  indices  of  variables  to  PROF_OUT 

53*-l 

I 

1,2, 

3,  40,  43,  5,  7,  8,  9,  14,16,  17,  18/  {  Ion,  lat , alt , Vw 

FIw, 

alfa, rol 

,  pit 

,  yaw,  dalfa, droll, dpitch, dyaw  } 

' FO_VAR 

IN (53)  indices  of  variables  to  FLY_OUT 

53*-l 

I 

1,2, 

3,  40,  43,  5,  7,  8,  9,  14,16,  17,  18/  {  Ion,  lat , alt , Vw 

FIw, 

alfa, rol 

II 

,  pit 

,  yaw, dalfa, droll, dpitch, dyaw  } 

GROUP  3 

,  Segment  Control  Parameters 

*  Each  pair  of  lines  in  GROUP  3  defines  a  segment  in  the  flight  profile. 
The  first  line  of  the  pair  is  the  segment  title,  and  the  second  line 
specifies  nine  parameters  that  define  the  maneuver.  Up  to  MXSEG 
segments  are  allowed  (see  file  dimens. prm) . 


Figure  C-1  (cent).  PROF_IN  Input  File  for  PROFGEN 
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*  Parameter  Definitions 


MANUVR  CH*4()  maneuver  type:  strt,  roll,  vert,  horz,  jink,  fall 

SEGLNT  DP ( )  segment  length 

PACC  DP ( )  path  acceleration 

TACC  DP ( )  turn  acceleration,  maximum  centrifugal  component 

DELHED  DP  ( )  desired  change  in  heading  angle  for  horizontal  turn, 

perturbation  in  heading  angle  for  jinking  maneuver 
DELPIT  DP ( )  desired  change  in  pitch  angle  for  vertical  turn, 

period  of  ground  wave  for  jinking  maneuver 
DELROL  DP ( )  desired  change  in  roll  angle  for  roll  maneuver 

PO_DT  DP ( )  time  interval  for  formatted  prints  to  PROE_OUT 

EO_DT  DP ( )  time  interval  for  unformatted  writes  to  FLY_OUT 


*  Parameter  Values 


MANUVR  SEGLNT 

PACC 

TACC 

DELHED 

DELPIT 

DELROL 

I  H 

I  Q 

I  I 

I  O 

I  CU 

II 

FO_DT 

“  sec 

gee 

gee 

deg 

deg-s 

deg 

sec 

sec 

'1  Ground-Lit  SRB  Ignition  and  Liftoff' 

's'  1.  1.0  0.  0.  0.  0.  1.  1. 

'2  Ground-Lit  SRB  Burnout  &  Air-lit  SRB  Ignition' 

'v'  60  1.9  0.5  0.  -5.  0.  5.  1. 

'3  Air-Lit  SRB  Burnout  &  Jettison' 

'v'  57.  0.25  2.22  0.  -20.  0.  5.  1. 

'4  Atlas  Booster  Engine  Cutoff  and  Booster  Pacakage  Jettison' 
'v'  50.  0.2  2.22  0.  -20.  0.  5.  1. 


MANUVR  SEGLNT 

PACC 

TACC 

DELHED 

DELPIT 

DELROL 

I  H 

I  Q 

I  I 

I  O 

I  CU 

II 

I  H 

I  Q 

I  I 

I  o 

I  [xj 

sec 

gee 

gee 

deg 

deg-s 

deg 

sec 

sec 

II 

'5  Payload  Fairing  Jettison' 

'v'  48.  0.18  1.1  0.  -5.  0.  5.  1. 

' 6  Sustainer  Engine  Cutoff  ' 

'v'  85.  0.4  1.3  0.  -10.  0.  10.  1. 


'7  Atlas/Centaur  Seperation' 

'v'  192.  0.3  1.7  0.  -20.  0.  50.  1. 

'8  Centaur  Main  Engine  Start  -  Cutoff' 

'v'  985.  0.3  0.8  0.  -10.  0.  50.  1. 


Figure  C-1  (cent).  PROF_IN  Input  File  for  PROFGEN 
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Appendix  D 

Adas  HAS  Rocket  Profile  Plots 


Although  this  Appendix  is  named  Atlas  HAS  Rocket  Profile  Plots,  The  Tanker 
Aireraft  Flight  Profile  is  also  ineluded  in  this  seetion  (Figures  D-8  and  D-9),  beeause  it  is 
used  in  this  research  for  MatSOFE  validation  purposes.  Notice  that  in  Figure  D-1,  the 
rocket  is  losing  altitude  after  about  600  sec.  of  flight,  which  seems  surprising;  but  in 
reality,  it  shows  correctly  that  a  peak  altitude  is  reached  and  the  rocket  is  making  an  orbit 
entry  maneuver. 


D-1 


Latitude  (deg)  Altitude  (feet) 


Atlas  2-D  Flight  Profile 


Figure  D-1 .  2-D  Rocket  Flight  Profile  (Alt  vs.  Time) 


Figure  D-2.  2-D  Rocket  Flight  Profile  (Lat  vs.  Lon) 
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Altitude  (feet)  Longitude  (deg) 


Time  (sec) 


Figure  D-3.  LatitucJe,  LongitucJe,  ancJ  AltitucJe  of  the  Rocket  Flight  Profile 
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Figure  D-4.  2-D  Position  and  Velocity  of  Rocket  Flight  Profile 
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Z-velocity  (knots)  ,  ,  Y-velocity  (knots)  X-velocity  (knots) 


Figure  D-5.  X,Y,  and  Z  Velocity  of  the  Rocket  Flight  Profile 
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Heading  Change  (deg)  Pitch  (deg)  Roll  (deg) 


X  10 


Figure  D-6.  Roll,  Pitch,  anct  Heacting  Change  of  the  Rocket  Flight  Profile 
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Time  (sec) 


Figure  D-7.  2-D  Position  and  Velocity  of  Tanker  Profile 


Figure  D-8.  Latitude,  Longitude,  and  Altitude  of  the  Tanker  Profile 
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Heading  Change  (deg)  Pitch  (deg)  Roll  (deg)  Z-velocity  (knots)  Y-velocity  (knots)  ^  X-velocity  (knots) 


Time  (sec) 


Figure  D-9.  X,Y,  and  Z  Velocity  of  the  Tanker  Profile 


Figure  D-10.  Roll,  Pitch,  and  Fleading  Change  of  the  Tanker  Profile 
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Appendix  E 

True  Ephemeris  Generation  Process 
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% 

% 

% 

% 

H 

H 

H 

% 

H 

H 

H 

% 

% 

% 

% 

% 

% 

% 

% 

H 

H 

H 

H 

H 

H 

% 

% 

% 

% 

% 


ADD_SV.H 

Purpose:  ADD_SV.M  loads  in  the  data  from  an  sp3  file  into  a  matlab 

record  by  using  "load_sp3"  routine,  and  extracts  necessary  data 
to  form  SV_ECEF  true  data.  Then  merges  that  true  SV_ECEF 
data  with  PROFGEN  output  . Finally  forms  a  new  "FLIGHT"  data, 
contains  both  INS  and  GPS  information  in  it 

first  18  colomn  of  flight  is  the  FLY_0UT's  first  18  colomn 
next  12  colomn  of  FLIGHT  is  SV  ECEF  coordanates (3  for  each  SV) 

Remarks:  The  SV  ECEF  data  is  in  kilometers  unit  and  in  UGS-84  ECEF 

coordinates  system.  It  will  be  converted  to  meters  here,  but 
Litton  ECEF  conversion  will  be  accomplished  in  TRJSYS.H 

NOTE  TO  USER:  The  . spO  file  has  gone  under  many  processes  and  finaly 
it  was  aligable  to  use  in  this  routine.  The  general  .sp3 
files  are  usually  in  15  minutes  or  more  output  rate.  This 
output  rate  is  adjusted  to  1  seconds  to  be  able  to  merge  with 
PROFGEN  outputs  (by  using  "utility"  softwares).  For  more 
information  see  these  web  pages; 

http: //WWW. arinc. com/gps/gpsstat.html 

http : / /WWW . nave  en.uscg.gov/gps/ default. htm# Almanac  s 

http://www.ngs.noaa. gov/C0RS/download2/ 

Inputs:  FLY_OUT.asc  - >  PROFGEN  output 

NG01JL28.SP3  - >  SV_ECEF  data(incl.  time) in  .SP3  type 

Outputs:  FLIGHT  - >  16  digid  ASCII  format  file 


%  Subroutines  or  Functions  Called:  load_sp3.m 
% 

%  Authors:  H. Istanbul luoglu 
%  16  Nov  2001 

% 


Figure  E-1 .  Matlab  m-file  “ADD_SV.M”  To  Merge  INS  and  GPS  data 
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■if  -if -l-CCCCl-CCtl-CCCCCS-CCl-CCCfS-CClfl-CCfCCl-CCCCi-S-S-Cl-CCCf  ft 

kkkkkhhkkkkkkkhkkkkkkkkkkkkkkkkkkkkkkkHHkkkkkkkkhkkkkk'f'f'fk'fkkkk'f'fkhkkkk'f'f 


format  long 

load  FLY_OUT.asc;  k  Prof gen  output 
num_cols  =  1450; 

sp3_data  =  load_sp3  ( 'MG01JL28. SP3 ' ) ; 
k  first  initialize  SV_data  matrix 
sv_data(l:num_cols,l: 12)  =  zeros; 


k  fpm  :  feet  per  meters  - >  conversion  from  meters  to  feet 

% 

fpm=3. 2808;| 
k 

k  k  convert  SV  ECEF  eph  data  into  feet  (from  km)  and  save  under  sv_data 

sv_data  (:,1:3)  =  sp3_data.prn{2} .pos (l:num_cols,l: 3) *1000*fpm; 

3v_data  (:,4:6)  =  sp3_data.prn{3} .pos (l:num_cols,l: 3) *1000*fpm; 

sv_data  (:,7:9)  =  3p3_data.prn{li} .pos (l:num_col3,i: 3) *1000*fpm; 

sv_data  (:,10:12)  =  sp3_data.prn{13} .pos (l:num_cois,l: 3) *1000*fpm; 

% 

k  Mow  merge  PROFGEN  output  with  true  SV_ECEF  data 
FLIGHT(l:num_cols  ,1:18)  =  FLY_OUT(l:num_cols  ,1:18); 

FLIGHT(l:num_cols  ,19:30)  =  sv_data  (l:num_cols  ,1:12); 
save  ( 'FLIGHT' , 'FLIGHT' ,' -ASCII ',' -DOUBLE ' ) 


U*.*.*.*.*.*, 


U*.*.*.*.*.*,< 


Figure  E-1  (cent.)  Matlab  m-file  “ADD_SV.M”  To  Merge  INS  and  GPS  data 
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h 

% 

H 

H 

k 

k 

k 

k 

k 

k 

k 

k 

k 

k 

k 

k 

% 

k 

k 

k 

k 

k 

k 

k 

k 

k 

k 

k 

k 

% 

k 


L0AD_SP3.H 

Purpose:  L0AD_SP3.H  loads  in  the  data  from  an  sp3  file  into  a  matlab 
record,  whih  then  will  be  merged  with  PROFGEN  output  to  form 
a  new  "FLIGHT"  data  containing  both  INS  and  GPS  information 

Remarks:  The  SV  ECEF  data  is  in  kilometers  unit  and  in  UGS-84  ECEF 

coordinates  system.  It  will  be  converted  to  meters  here,  but 
Litton  ECEF  conversion  will  be  accomplished  later. 

when  typed, 

sp3.prn{ j } . time  - >  returns  time 

3p3.prn{ j } .pos  - >  returns  3  dim.  ECEF  position  data 

sp3.prn{J }. clock  - >  returns  sv  clock  information 

NOTE  TO  USER:  The  .sp3  file  has  gone  under  many  processes  and  finaly 
it  was  aligable  to  use  in  this  routine.  The  general  . sp3 
files  are  usually  in  15  minutes  or  more  output  rate.  This 
output  rate  is  adjusted  to  1  seconds  to  be  able  to  merge  with 
PROFGEN  outputs  (by  using  "utility"  softwares).  For  more 
information  see  these  web  pages; 

http: //WWW. arinc.com/gps/gpsstat.html 

http : / /WWW . nave  en . us  c  g . gov/ gp  s / de  f  aul t . htm# Almanac  s 

http : / /WWW . ngs . no  aa . gov/ C  ORS / downl o  ad2 / 

Inputs:  NG01JL28.SP3  - >  SV_ECEF  data(incl.  time) in  .SP3  type 

Outputs:  sp3_data  - >  prn{lX32  cell}  num_j)oints[32xl  double] 

Subroutines  or  Functions  Called:  NONE 


k 

k  Authors:  UNKNOWN 


k  Provided  by  :  Haj.John  F.Raquet  /  AFIT  /  ENG 
k 

k  Arranged  by  :  H. Istanbul luoglu 
%  16  Nov  2001 

% 

kkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkk 


function  sp3_data  =  load_sp3 {sp3_file) 


fid=fopen(sp3_file, ' r ' ) ; 
fgetl  (fid) ; 
data=fgetl (fid) ; 

data=sscanf (data, ' %d  %f  %f',3); 
week=data(l) ; 
start_time=data(2) ; 
interval=data(3) ; 

data=fgetl (f id) ; 

dl=sscanf (data(9: end) , '  %d'); 

data=fgetl (fid) ; 

d2=sscanf (data(9: end) , '  %d'); 

prn_vec=[dl'  d2 ' ] ' ; 


Figure  E-2.  Matlab  m-file  “LOAD_SP3.M” 
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fgetl  (fid) ; 
fgetl  (fid) ; 
fgetl  (fid) ; 

data=fgetl (fid) ; 

dl=33canf (data(9: end) , '  %d'); 

data=fgetl (fid) ; 

d2=33canf (data(9: end) , '  %d'); 

acc_vec= [ dl '  d2 ' ] ' ; 

nuKi_to_add=500 ; 

H  initialize  3p3  record 
for  j=l:32 

3p3.prn{  j }  .nuiii_point3=0; 

3p3.prn{  j } .  tinie=zero3  (num_to_add,  1) ; 

3p3.prn{  j }  .pos=zero3  (nuia_to_add,  3) ; 

3p3.prn{ j } . clock=zero3 (num_to_add,  1) ; 

end 

for  j=l: length(prn_vec) 
if  prn_vec (i ) ~=0 
acc=acc_vec ( j ) ; 
if  acc~=0 

acc=  (2''acc)  /lOOO; 
end 

sp3.prn{prn_vec ( j ) } . accuracY=acc; 

end 

end 

while  ~3trcmp ( ' * ' ,data(l) ) 
data=fgetl (fid) ; 
end 

d=sscanf (data(2:end) , '  %d  %d  %d  %d  %d  %f'); 

fir3t_day=d(3) ; 

done=0; 
while  ~done 

day=d(3) ; 
hour=d(4) ; 
iiiinute=d(S) ; 

3econd=d(6) ; 

time=3tart_tiiae+3econd+minute*60+hour*3600+(day-fir3t_day) *86400 

done_r  e  ading_ep  o  ch=  0 ; 
while  ~done_reading_epoch 

data=f gets (fid) ; 
if  strcmp ( ' * ' ,data(l) ) 
done_r  e  ading_ep  o  ch= 1 ; 
else 


Figure  E-2  (cent.)  Matlab  m-file  “LOAD_SP3.M 
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[ d, count] =sscanf (data, ' P  %d  %f  %f  %f  %f'); 
if  count<5 

if  ~3trcmp ( 'EOF' ,data(l: 3) ) 

disp (sprintf ( ' A.  Error  reading  line:  %s',data)) 

end 

done=l; 

break 

end 

prn=d(l) ; 

spS . prn{prn} . num_points=sp3 . prn{prn} . num_points+l ; 

n=sp3.prn{prn}  .ntm_points; 

if  n  >  length(3p3.prn{prn} . time) 

sp3.prn{prn) . time=[sp3.prn{prn} . time;  zeros (num_to_add,  1)]; 
sp3.prn{prn} .pos=[sp3.prn{prn} .pos;  zeros (num_to_add,  3)]; 
sp3.prn{prn} . clock=[3p3.prn{prn} . clock;  zeros (num_to_add,  1) ] 

end 

3p3.prn{prn} . time (n) =time; 
sp3.prn{prn} .pos (n,l: 3) =d(2: 4) ; 

3p3.prn{prn} . clock (n) =d(5) ; 

end 

end 

[d,count]=S3canf (data(2: end) , '  %d  %d  %d  %d  %d  %f'); 
if  count<6 

if  ~strcmp ( 'EOF' ,data(l: 3) ) 

disp (sprintf ( 'B.  Error  reading  line:  %s',data)) 

end 

done=l; 

end 

end 

for  j=l:32 

n=sp3.prn{ j } .num_points; 
if  n>0 

sp3.prn{ j } . time=sp3.prn{i ) . time (l:n) ; 
sp3.prn{ j } .pos=3p3.prn{i > .pos (l:n, : ) ; 
sp3.prn{ j } . clock=sp3.prn{i } . clock (l:n) ; 

end 

end 

3p3 . num_point3=zer 03 (32,1); 
for  j=l:32 

sp3.num_points  ( j )  =3p3.prn{  j  }  .nvim_point3; 
end 

3p3_data=3p3; 


Figure  E-2  (cent.)  Matlab  m-file  “L0AD_SP3.M” 
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Appendix  F 

Plots  Obtained  from  WSEM  3.6 

The  following  Tables  show  how  WSEM  software  helps  determine  the  four  best 
visible  satellites.  The  tables  presented  in  this  section  are  the  actual  WSEM  outputs  for  the 
satellites  chosen  and  used  in  this  research. 


Table  F-1.  WSEM  Set-Up  Parameters 


W5EK  V3.6.<9  AUXILIARY  OUTPUT  TABLE 
INPUTTED  VALUE  COMPUTED 


SEM  VALUE 


POSITIONS 

POSITION; 


LaclTUde  (N|  39  SS'  O.DD'' 

LonaiTsuae  <hi  84  33'  o.oo'' 

AIt.it.uile  lei)  25X.4C 

True  Heading  (deg)  232 


TIME  ;  Dote  (wm/ctd/yy)  07/28/2001 


Beg  time  Ihhimm)  04:00  UTC 


ECEF  X 
ECEF  Y 
ECEP  2 


OPS  Ucc); 
Day  0£  Ye  at: 


465277. 758 
-4076697, 409 
40710S4.S36 


112  4 
209 


Time  oY  veeic  (sec)  532800 
Z  Cdunt  355200 


INPUT  PARAMETERS 

Almanac  File:  D72801A.AL3  Scenario  Duration  IbrsI :  2 

UE  Signal  Tracking  Capability:  P-Cade  DOP  Selection:  PDOP 

UE  Aiding:  Baro  Alcimetei:  Aiding  UE  BasA  Angle  (degrees!  :  10.0 

Accuracy  o£  Baro  Altieeler  (eetera) :  75.00  SVa  Used:  9 
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Lat  39N  55'  0  00" 
Long  84W33'0  00" 


Ol 

O 

Q 


PDOP-UNE 

Based  on  best  PDOP  SVs 


Date:  07/28/01 
PDOP  1,36  UNE  2944 
50 


40 


30 


20 


10 


LLI 


Best  PDOP  PRNs:  1  3  8  13  22  27  28  31  V 


UTCTime 

0400 


Lat  39N55'0  00" 
Long  84W33'0  00" 


Q. 

O 

Q 


PDOP-UNE 

Based  on  best  PDOP  SVs 


PDOP 


Date:  07/28/01 
1  28  UNE  23  28 
50 


40 


30 


20 


10 


lU 

Z 

3 


Best  PDOP  PRNs  2  3  8  1 1  13  27  28  31  V 


UTC  Time 
0530 


Figure  F-1 .  PDOP  (Start  Time  and  Final  Time) 
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Figure  F-  2.  Satellite  Elevation/Time  Graph 
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Figure  F-3.  Satellite  Rise/Set  Graph 
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Figure  F-5.  Bearing/Elevation  Graph 
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Table  F-2.  Satellite  Bearing/Elevation  Table 


UTCTime 

PRN3 

PRN8 

PRW13 

PRN31 

POOP 

HOOP 

VDOP 

GDOP 

BestSVs 

0^:00 

1?1|50 

73123 

5/55 

271/68 

1,36 

1,03 

0,89 

1,52 

1,3,8,13,22,27,28,31,9 

0^;05 

1S3I19 

71121 

1/51 

265/70 

1,31 

1,02 

0,88 

1,51 

1,3,8,13,22,27,28,31,9 

01:10 

186|17 

75126 

353/  52 

259/71 

1,33 

1,01 

0,87 

1,19 

1,3,8,13,22,27,28,31,9 

01:15 
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355/  50 
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1,33 

1,00 

0,87 

1,18 
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01:20 
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76130 

353/  19 

213/73 

1,32 
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0,86 
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01:25 
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1,32 

1,00 

0,86 

1,17 
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1,27 

0,91 

0,85 
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0,89 
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0,90 
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198/69 

1,27 

0,91 
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m 
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m 
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m 
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Appendix  G 

MatSOFE  Validation  Plots 
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Figure  G-1 .  Latitude,  Longitude,  and  Altitude  Errors 
(MatSOFE  output  for  Gray’s  study  case) 


Figure  G-2.  Latitude,  Longitude,  and  Altitude  Errors 
(MSOFE  output  for  Gray’s  study  case) 
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Figure  G-3.  Latitude,  Longitude,  and  Altitude  Errors 
(MatSOFE  output  for  Britton’s  study  case) 
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Figure  G-4.  Latitude,  Longitude,  and  Altitude  Errors 
(MSOFE  output  for  Britton’s  study  case) 
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Figure  G-5.  Latitude,  Longitude,  and  Altitude  Errors 
(MatSOFE  output  for  Mosle’s  study  case) 


Figure  G-6.  Latitude,  Longitude,  and  Altitude  Errors 
(MSOFE  output  for  Mosle’s  study  case) 
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Appendix  H 

Tuning  Examples 
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Figure  H-1.  Latitude  and  Longitude  Errors  (Conservative  Q-Tuning) 
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Figure  H-2.  Latitude  and  Longitude  Errors  (Non-Conservative  Q-Tuning) 
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Figure  H-3.  East  and  North  Velocity  Errors  (Conservative  Q-Tuning) 
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Figure  H-4.  East  and  North  Velocity  Errors  (Non-Conservative  Q-Tuning) 
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Figure  H-5.  East,  North,  and  Up  Tilt  Errors  (Conservative  Q-Tuning) 
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Figure  H-6.  East,  North,  and  Up  Tilt  Errors  (Non-Conservative  Q-Tuning) 
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Appendix  I 

Plots  of  Case  I 
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Figure  1-1 .  Rocket  Latitude  and  Longitude  Errors 
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Figure  I-2.  Rocket  Altitude  and  Baro-Altimeter  Errors 
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Figure  1-3.  Rocket  Latitude,  Longitude,  and  Altitude  Errors 
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Figure  1-4.  East,  North,  and  Vertical  Tilt  Errors 
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Figure  1-5.  East,  North,  and  Vertical  Velocity  Errors 
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Figure  I-  6.  GPS  User  Clock  Bias  and  Clock  Drift  Errors 
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Appendix  J 

Plots  of  Case  II 
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Figure  J-1.  Rocket  Latitude  and  Longitude  Errors 
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Figure  J-2.  Rocket  Altitude  and  Baro-Altimeter  Errors 
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Figure  J-3.  Rocket  Latitude,  Longitude,  and  Altitude  Errors 
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Figure  J-4.  East,  North,  and  Vertical  Tilt  Errors 
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Figure  J-5.  East,  North,  and  Vertical  Velocity  Errors 
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Figure  J-6.  DGPS  User  Clock  Bias  and  Clock  Drift  Errors 
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Appendix  K 

Plots  of  Case  III 
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Figure  K-1.  Rocket  Latitude  and  Longitude  Errors 
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Figure  K-2.  Rocket  Altitude  and  Baro-Altimeter  Errors 
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Figure  K-3.  Rocket  Latitude,  Longitude,  and  Altitude  Errors 

K4 


East  Tilt  Error 


North  Tilt  Error 


Vertical(Up)  Tilt  Error 


Figure  K-4.  East,  North,  and  Vertical  Tilt  Errors 
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Figure  K-5.  East,  North,  and  Vertical  Velocity  Errors 
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Figure  K-6.  GPS  User  Clock  Bias  and  Clock  Drift  Errors 
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Appendix  L 

Plots  of  Case  IV 


Hot  legend: 
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Figure  L-1 .  Rocket  Latitude  and  Longitude  Errors 
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Figure  L-2.  Rocket  Altitude  and  Baro-Altimeter  Errors 
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Figure  L-3.  Rocket  Latitude,  Longitude,  and  Altitude  Errors 
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Figure  L-4.  East,  North,  and  Vertical  Tilt  Errors 
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Figure  L-5.  East,  North,  and  Vertical  Velocity  Errors 
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Figure  L-6.  DGPS  User  Clock  Bias  and  Clock  Drift  Errors 
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Appendix  M, 

Plots  of  Case  V 
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Figure  M-1.  Rocket  Latitude  and  Longitude  Errors 
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Figure  M-2.  Rocket  Altitude  and  Baro-Altimeter  Errors 
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Figure  M-3.  Rocket  Latitude,  Longitude,  and  Altitude  Errors 
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Figure  M-4.  East,  North,  and  Vertical  Tilt  Errors 
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Figure  M-5.  East,  North,  and  Vertical  Velocity  Errors 
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Figure  M-6.  GPS  User  Clock  Bias  and  Clock  Drift  Errors 
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Appendix  N 

Plots  of  Case  VI 
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Figure  N-1 .  Rocket  Latitude  and  Longitude  Errors 
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Figure  N-2.  Rocket  Altitude  and  Baro-Altimeter  Errors 
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Figure  N-3.  Rocket  Latitude,  Longitude,  and  Altitude  Errors 


N4 


arcseconds  arcseconds  arcseconds 


East  Tilt  Error 


North  Tilt  Error 


Vertical(Up)  Tilt  Error 


Time  (sec) 

Figure  N-4.  East,  North,  and  Vertical  Tilt  Errors 
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Figure  N-5.  East,  North,  and  Vertical  Velocity  Errors 
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Figure  N-6.  DGPS  User  Clock  Bias  and  Clock  Drift  Errors 
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